1 // SPDX-License-Identifier: GPL-2.0-or-later 2 /* 3 * forcedeth: Ethernet driver for NVIDIA nForce media access controllers. 4 * 5 * Note: This driver is a cleanroom reimplementation based on reverse 6 * engineered documentation written by Carl-Daniel Hailfinger 7 * and Andrew de Quincey. 8 * 9 * NVIDIA, nForce and other NVIDIA marks are trademarks or registered 10 * trademarks of NVIDIA Corporation in the United States and other 11 * countries. 12 * 13 * Copyright (C) 2003,4,5 Manfred Spraul 14 * Copyright (C) 2004 Andrew de Quincey (wol support) 15 * Copyright (C) 2004 Carl-Daniel Hailfinger (invalid MAC handling, insane 16 * IRQ rate fixes, bigendian fixes, cleanups, verification) 17 * Copyright (c) 2004,2005,2006,2007,2008,2009 NVIDIA Corporation 18 * 19 * Known bugs: 20 * We suspect that on some hardware no TX done interrupts are generated. 21 * This means recovery from netif_stop_queue only happens if the hw timer 22 * interrupt fires (100 times/second, configurable with NVREG_POLL_DEFAULT) 23 * and the timer is active in the IRQMask, or if a rx packet arrives by chance. 24 * If your hardware reliably generates tx done interrupts, then you can remove 25 * DEV_NEED_TIMERIRQ from the driver_data flags. 26 * DEV_NEED_TIMERIRQ will not harm you on sane hardware, only generating a few 27 * superfluous timer interrupts from the nic. 28 */ 29 30 #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt 31 32 #define FORCEDETH_VERSION "0.64" 33 #define DRV_NAME "forcedeth" 34 35 #include <linux/module.h> 36 #include <linux/types.h> 37 #include <linux/pci.h> 38 #include <linux/interrupt.h> 39 #include <linux/netdevice.h> 40 #include <linux/etherdevice.h> 41 #include <linux/delay.h> 42 #include <linux/sched.h> 43 #include <linux/spinlock.h> 44 #include <linux/ethtool.h> 45 #include <linux/timer.h> 46 #include <linux/skbuff.h> 47 #include <linux/mii.h> 48 #include <linux/random.h> 49 #include <linux/if_vlan.h> 50 #include <linux/dma-mapping.h> 51 #include <linux/slab.h> 52 #include <linux/uaccess.h> 53 #include <linux/prefetch.h> 54 #include <linux/u64_stats_sync.h> 55 #include <linux/io.h> 56 57 #include <asm/irq.h> 58 59 #define TX_WORK_PER_LOOP 64 60 #define RX_WORK_PER_LOOP 64 61 62 /* 63 * Hardware access: 64 */ 65 66 #define DEV_NEED_TIMERIRQ 0x0000001 /* set the timer irq flag in the irq mask */ 67 #define DEV_NEED_LINKTIMER 0x0000002 /* poll link settings. Relies on the timer irq */ 68 #define DEV_HAS_LARGEDESC 0x0000004 /* device supports jumbo frames and needs packet format 2 */ 69 #define DEV_HAS_HIGH_DMA 0x0000008 /* device supports 64bit dma */ 70 #define DEV_HAS_CHECKSUM 0x0000010 /* device supports tx and rx checksum offloads */ 71 #define DEV_HAS_VLAN 0x0000020 /* device supports vlan tagging and striping */ 72 #define DEV_HAS_MSI 0x0000040 /* device supports MSI */ 73 #define DEV_HAS_MSI_X 0x0000080 /* device supports MSI-X */ 74 #define DEV_HAS_POWER_CNTRL 0x0000100 /* device supports power savings */ 75 #define DEV_HAS_STATISTICS_V1 0x0000200 /* device supports hw statistics version 1 */ 76 #define DEV_HAS_STATISTICS_V2 0x0000400 /* device supports hw statistics version 2 */ 77 #define DEV_HAS_STATISTICS_V3 0x0000800 /* device supports hw statistics version 3 */ 78 #define DEV_HAS_STATISTICS_V12 0x0000600 /* device supports hw statistics version 1 and 2 */ 79 #define DEV_HAS_STATISTICS_V123 0x0000e00 /* device supports hw statistics version 1, 2, and 3 */ 80 #define DEV_HAS_TEST_EXTENDED 0x0001000 /* device supports extended diagnostic test */ 81 #define DEV_HAS_MGMT_UNIT 0x0002000 /* device supports management unit */ 82 #define DEV_HAS_CORRECT_MACADDR 0x0004000 /* device supports correct mac address order */ 83 #define DEV_HAS_COLLISION_FIX 0x0008000 /* device supports tx collision fix */ 84 #define DEV_HAS_PAUSEFRAME_TX_V1 0x0010000 /* device supports tx pause frames version 1 */ 85 #define DEV_HAS_PAUSEFRAME_TX_V2 0x0020000 /* device supports tx pause frames version 2 */ 86 #define DEV_HAS_PAUSEFRAME_TX_V3 0x0040000 /* device supports tx pause frames version 3 */ 87 #define DEV_NEED_TX_LIMIT 0x0080000 /* device needs to limit tx */ 88 #define DEV_NEED_TX_LIMIT2 0x0180000 /* device needs to limit tx, expect for some revs */ 89 #define DEV_HAS_GEAR_MODE 0x0200000 /* device supports gear mode */ 90 #define DEV_NEED_PHY_INIT_FIX 0x0400000 /* device needs specific phy workaround */ 91 #define DEV_NEED_LOW_POWER_FIX 0x0800000 /* device needs special power up workaround */ 92 #define DEV_NEED_MSI_FIX 0x1000000 /* device needs msi workaround */ 93 94 enum { 95 NvRegIrqStatus = 0x000, 96 #define NVREG_IRQSTAT_MIIEVENT 0x040 97 #define NVREG_IRQSTAT_MASK 0x83ff 98 NvRegIrqMask = 0x004, 99 #define NVREG_IRQ_RX_ERROR 0x0001 100 #define NVREG_IRQ_RX 0x0002 101 #define NVREG_IRQ_RX_NOBUF 0x0004 102 #define NVREG_IRQ_TX_ERR 0x0008 103 #define NVREG_IRQ_TX_OK 0x0010 104 #define NVREG_IRQ_TIMER 0x0020 105 #define NVREG_IRQ_LINK 0x0040 106 #define NVREG_IRQ_RX_FORCED 0x0080 107 #define NVREG_IRQ_TX_FORCED 0x0100 108 #define NVREG_IRQ_RECOVER_ERROR 0x8200 109 #define NVREG_IRQMASK_THROUGHPUT 0x00df 110 #define NVREG_IRQMASK_CPU 0x0060 111 #define NVREG_IRQ_TX_ALL (NVREG_IRQ_TX_ERR|NVREG_IRQ_TX_OK|NVREG_IRQ_TX_FORCED) 112 #define NVREG_IRQ_RX_ALL (NVREG_IRQ_RX_ERROR|NVREG_IRQ_RX|NVREG_IRQ_RX_NOBUF|NVREG_IRQ_RX_FORCED) 113 #define NVREG_IRQ_OTHER (NVREG_IRQ_TIMER|NVREG_IRQ_LINK|NVREG_IRQ_RECOVER_ERROR) 114 115 NvRegUnknownSetupReg6 = 0x008, 116 #define NVREG_UNKSETUP6_VAL 3 117 118 /* 119 * NVREG_POLL_DEFAULT is the interval length of the timer source on the nic 120 * NVREG_POLL_DEFAULT=97 would result in an interval length of 1 ms 121 */ 122 NvRegPollingInterval = 0x00c, 123 #define NVREG_POLL_DEFAULT_THROUGHPUT 65535 /* backup tx cleanup if loop max reached */ 124 #define NVREG_POLL_DEFAULT_CPU 13 125 NvRegMSIMap0 = 0x020, 126 NvRegMSIMap1 = 0x024, 127 NvRegMSIIrqMask = 0x030, 128 #define NVREG_MSI_VECTOR_0_ENABLED 0x01 129 NvRegMisc1 = 0x080, 130 #define NVREG_MISC1_PAUSE_TX 0x01 131 #define NVREG_MISC1_HD 0x02 132 #define NVREG_MISC1_FORCE 0x3b0f3c 133 134 NvRegMacReset = 0x34, 135 #define NVREG_MAC_RESET_ASSERT 0x0F3 136 NvRegTransmitterControl = 0x084, 137 #define NVREG_XMITCTL_START 0x01 138 #define NVREG_XMITCTL_MGMT_ST 0x40000000 139 #define NVREG_XMITCTL_SYNC_MASK 0x000f0000 140 #define NVREG_XMITCTL_SYNC_NOT_READY 0x0 141 #define NVREG_XMITCTL_SYNC_PHY_INIT 0x00040000 142 #define NVREG_XMITCTL_MGMT_SEMA_MASK 0x00000f00 143 #define NVREG_XMITCTL_MGMT_SEMA_FREE 0x0 144 #define NVREG_XMITCTL_HOST_SEMA_MASK 0x0000f000 145 #define NVREG_XMITCTL_HOST_SEMA_ACQ 0x0000f000 146 #define NVREG_XMITCTL_HOST_LOADED 0x00004000 147 #define NVREG_XMITCTL_TX_PATH_EN 0x01000000 148 #define NVREG_XMITCTL_DATA_START 0x00100000 149 #define NVREG_XMITCTL_DATA_READY 0x00010000 150 #define NVREG_XMITCTL_DATA_ERROR 0x00020000 151 NvRegTransmitterStatus = 0x088, 152 #define NVREG_XMITSTAT_BUSY 0x01 153 154 NvRegPacketFilterFlags = 0x8c, 155 #define NVREG_PFF_PAUSE_RX 0x08 156 #define NVREG_PFF_ALWAYS 0x7F0000 157 #define NVREG_PFF_PROMISC 0x80 158 #define NVREG_PFF_MYADDR 0x20 159 #define NVREG_PFF_LOOPBACK 0x10 160 161 NvRegOffloadConfig = 0x90, 162 #define NVREG_OFFLOAD_HOMEPHY 0x601 163 #define NVREG_OFFLOAD_NORMAL RX_NIC_BUFSIZE 164 NvRegReceiverControl = 0x094, 165 #define NVREG_RCVCTL_START 0x01 166 #define NVREG_RCVCTL_RX_PATH_EN 0x01000000 167 NvRegReceiverStatus = 0x98, 168 #define NVREG_RCVSTAT_BUSY 0x01 169 170 NvRegSlotTime = 0x9c, 171 #define NVREG_SLOTTIME_LEGBF_ENABLED 0x80000000 172 #define NVREG_SLOTTIME_10_100_FULL 0x00007f00 173 #define NVREG_SLOTTIME_1000_FULL 0x0003ff00 174 #define NVREG_SLOTTIME_HALF 0x0000ff00 175 #define NVREG_SLOTTIME_DEFAULT 0x00007f00 176 #define NVREG_SLOTTIME_MASK 0x000000ff 177 178 NvRegTxDeferral = 0xA0, 179 #define NVREG_TX_DEFERRAL_DEFAULT 0x15050f 180 #define NVREG_TX_DEFERRAL_RGMII_10_100 0x16070f 181 #define NVREG_TX_DEFERRAL_RGMII_1000 0x14050f 182 #define NVREG_TX_DEFERRAL_RGMII_STRETCH_10 0x16190f 183 #define NVREG_TX_DEFERRAL_RGMII_STRETCH_100 0x16300f 184 #define NVREG_TX_DEFERRAL_MII_STRETCH 0x152000 185 NvRegRxDeferral = 0xA4, 186 #define NVREG_RX_DEFERRAL_DEFAULT 0x16 187 NvRegMacAddrA = 0xA8, 188 NvRegMacAddrB = 0xAC, 189 NvRegMulticastAddrA = 0xB0, 190 #define NVREG_MCASTADDRA_FORCE 0x01 191 NvRegMulticastAddrB = 0xB4, 192 NvRegMulticastMaskA = 0xB8, 193 #define NVREG_MCASTMASKA_NONE 0xffffffff 194 NvRegMulticastMaskB = 0xBC, 195 #define NVREG_MCASTMASKB_NONE 0xffff 196 197 NvRegPhyInterface = 0xC0, 198 #define PHY_RGMII 0x10000000 199 NvRegBackOffControl = 0xC4, 200 #define NVREG_BKOFFCTRL_DEFAULT 0x70000000 201 #define NVREG_BKOFFCTRL_SEED_MASK 0x000003ff 202 #define NVREG_BKOFFCTRL_SELECT 24 203 #define NVREG_BKOFFCTRL_GEAR 12 204 205 NvRegTxRingPhysAddr = 0x100, 206 NvRegRxRingPhysAddr = 0x104, 207 NvRegRingSizes = 0x108, 208 #define NVREG_RINGSZ_TXSHIFT 0 209 #define NVREG_RINGSZ_RXSHIFT 16 210 NvRegTransmitPoll = 0x10c, 211 #define NVREG_TRANSMITPOLL_MAC_ADDR_REV 0x00008000 212 NvRegLinkSpeed = 0x110, 213 #define NVREG_LINKSPEED_FORCE 0x10000 214 #define NVREG_LINKSPEED_10 1000 215 #define NVREG_LINKSPEED_100 100 216 #define NVREG_LINKSPEED_1000 50 217 #define NVREG_LINKSPEED_MASK (0xFFF) 218 NvRegUnknownSetupReg5 = 0x130, 219 #define NVREG_UNKSETUP5_BIT31 (1<<31) 220 NvRegTxWatermark = 0x13c, 221 #define NVREG_TX_WM_DESC1_DEFAULT 0x0200010 222 #define NVREG_TX_WM_DESC2_3_DEFAULT 0x1e08000 223 #define NVREG_TX_WM_DESC2_3_1000 0xfe08000 224 NvRegTxRxControl = 0x144, 225 #define NVREG_TXRXCTL_KICK 0x0001 226 #define NVREG_TXRXCTL_BIT1 0x0002 227 #define NVREG_TXRXCTL_BIT2 0x0004 228 #define NVREG_TXRXCTL_IDLE 0x0008 229 #define NVREG_TXRXCTL_RESET 0x0010 230 #define NVREG_TXRXCTL_RXCHECK 0x0400 231 #define NVREG_TXRXCTL_DESC_1 0 232 #define NVREG_TXRXCTL_DESC_2 0x002100 233 #define NVREG_TXRXCTL_DESC_3 0xc02200 234 #define NVREG_TXRXCTL_VLANSTRIP 0x00040 235 #define NVREG_TXRXCTL_VLANINS 0x00080 236 NvRegTxRingPhysAddrHigh = 0x148, 237 NvRegRxRingPhysAddrHigh = 0x14C, 238 NvRegTxPauseFrame = 0x170, 239 #define NVREG_TX_PAUSEFRAME_DISABLE 0x0fff0080 240 #define NVREG_TX_PAUSEFRAME_ENABLE_V1 0x01800010 241 #define NVREG_TX_PAUSEFRAME_ENABLE_V2 0x056003f0 242 #define NVREG_TX_PAUSEFRAME_ENABLE_V3 0x09f00880 243 NvRegTxPauseFrameLimit = 0x174, 244 #define NVREG_TX_PAUSEFRAMELIMIT_ENABLE 0x00010000 245 NvRegMIIStatus = 0x180, 246 #define NVREG_MIISTAT_ERROR 0x0001 247 #define NVREG_MIISTAT_LINKCHANGE 0x0008 248 #define NVREG_MIISTAT_MASK_RW 0x0007 249 #define NVREG_MIISTAT_MASK_ALL 0x000f 250 NvRegMIIMask = 0x184, 251 #define NVREG_MII_LINKCHANGE 0x0008 252 253 NvRegAdapterControl = 0x188, 254 #define NVREG_ADAPTCTL_START 0x02 255 #define NVREG_ADAPTCTL_LINKUP 0x04 256 #define NVREG_ADAPTCTL_PHYVALID 0x40000 257 #define NVREG_ADAPTCTL_RUNNING 0x100000 258 #define NVREG_ADAPTCTL_PHYSHIFT 24 259 NvRegMIISpeed = 0x18c, 260 #define NVREG_MIISPEED_BIT8 (1<<8) 261 #define NVREG_MIIDELAY 5 262 NvRegMIIControl = 0x190, 263 #define NVREG_MIICTL_INUSE 0x08000 264 #define NVREG_MIICTL_WRITE 0x00400 265 #define NVREG_MIICTL_ADDRSHIFT 5 266 NvRegMIIData = 0x194, 267 NvRegTxUnicast = 0x1a0, 268 NvRegTxMulticast = 0x1a4, 269 NvRegTxBroadcast = 0x1a8, 270 NvRegWakeUpFlags = 0x200, 271 #define NVREG_WAKEUPFLAGS_VAL 0x7770 272 #define NVREG_WAKEUPFLAGS_BUSYSHIFT 24 273 #define NVREG_WAKEUPFLAGS_ENABLESHIFT 16 274 #define NVREG_WAKEUPFLAGS_D3SHIFT 12 275 #define NVREG_WAKEUPFLAGS_D2SHIFT 8 276 #define NVREG_WAKEUPFLAGS_D1SHIFT 4 277 #define NVREG_WAKEUPFLAGS_D0SHIFT 0 278 #define NVREG_WAKEUPFLAGS_ACCEPT_MAGPAT 0x01 279 #define NVREG_WAKEUPFLAGS_ACCEPT_WAKEUPPAT 0x02 280 #define NVREG_WAKEUPFLAGS_ACCEPT_LINKCHANGE 0x04 281 #define NVREG_WAKEUPFLAGS_ENABLE 0x1111 282 283 NvRegMgmtUnitGetVersion = 0x204, 284 #define NVREG_MGMTUNITGETVERSION 0x01 285 NvRegMgmtUnitVersion = 0x208, 286 #define NVREG_MGMTUNITVERSION 0x08 287 NvRegPowerCap = 0x268, 288 #define NVREG_POWERCAP_D3SUPP (1<<30) 289 #define NVREG_POWERCAP_D2SUPP (1<<26) 290 #define NVREG_POWERCAP_D1SUPP (1<<25) 291 NvRegPowerState = 0x26c, 292 #define NVREG_POWERSTATE_POWEREDUP 0x8000 293 #define NVREG_POWERSTATE_VALID 0x0100 294 #define NVREG_POWERSTATE_MASK 0x0003 295 #define NVREG_POWERSTATE_D0 0x0000 296 #define NVREG_POWERSTATE_D1 0x0001 297 #define NVREG_POWERSTATE_D2 0x0002 298 #define NVREG_POWERSTATE_D3 0x0003 299 NvRegMgmtUnitControl = 0x278, 300 #define NVREG_MGMTUNITCONTROL_INUSE 0x20000 301 NvRegTxCnt = 0x280, 302 NvRegTxZeroReXmt = 0x284, 303 NvRegTxOneReXmt = 0x288, 304 NvRegTxManyReXmt = 0x28c, 305 NvRegTxLateCol = 0x290, 306 NvRegTxUnderflow = 0x294, 307 NvRegTxLossCarrier = 0x298, 308 NvRegTxExcessDef = 0x29c, 309 NvRegTxRetryErr = 0x2a0, 310 NvRegRxFrameErr = 0x2a4, 311 NvRegRxExtraByte = 0x2a8, 312 NvRegRxLateCol = 0x2ac, 313 NvRegRxRunt = 0x2b0, 314 NvRegRxFrameTooLong = 0x2b4, 315 NvRegRxOverflow = 0x2b8, 316 NvRegRxFCSErr = 0x2bc, 317 NvRegRxFrameAlignErr = 0x2c0, 318 NvRegRxLenErr = 0x2c4, 319 NvRegRxUnicast = 0x2c8, 320 NvRegRxMulticast = 0x2cc, 321 NvRegRxBroadcast = 0x2d0, 322 NvRegTxDef = 0x2d4, 323 NvRegTxFrame = 0x2d8, 324 NvRegRxCnt = 0x2dc, 325 NvRegTxPause = 0x2e0, 326 NvRegRxPause = 0x2e4, 327 NvRegRxDropFrame = 0x2e8, 328 NvRegVlanControl = 0x300, 329 #define NVREG_VLANCONTROL_ENABLE 0x2000 330 NvRegMSIXMap0 = 0x3e0, 331 NvRegMSIXMap1 = 0x3e4, 332 NvRegMSIXIrqStatus = 0x3f0, 333 334 NvRegPowerState2 = 0x600, 335 #define NVREG_POWERSTATE2_POWERUP_MASK 0x0F15 336 #define NVREG_POWERSTATE2_POWERUP_REV_A3 0x0001 337 #define NVREG_POWERSTATE2_PHY_RESET 0x0004 338 #define NVREG_POWERSTATE2_GATE_CLOCKS 0x0F00 339 }; 340 341 /* Big endian: should work, but is untested */ 342 struct ring_desc { 343 __le32 buf; 344 __le32 flaglen; 345 }; 346 347 struct ring_desc_ex { 348 __le32 bufhigh; 349 __le32 buflow; 350 __le32 txvlan; 351 __le32 flaglen; 352 }; 353 354 union ring_type { 355 struct ring_desc *orig; 356 struct ring_desc_ex *ex; 357 }; 358 359 #define FLAG_MASK_V1 0xffff0000 360 #define FLAG_MASK_V2 0xffffc000 361 #define LEN_MASK_V1 (0xffffffff ^ FLAG_MASK_V1) 362 #define LEN_MASK_V2 (0xffffffff ^ FLAG_MASK_V2) 363 364 #define NV_TX_LASTPACKET (1<<16) 365 #define NV_TX_RETRYERROR (1<<19) 366 #define NV_TX_RETRYCOUNT_MASK (0xF<<20) 367 #define NV_TX_FORCED_INTERRUPT (1<<24) 368 #define NV_TX_DEFERRED (1<<26) 369 #define NV_TX_CARRIERLOST (1<<27) 370 #define NV_TX_LATECOLLISION (1<<28) 371 #define NV_TX_UNDERFLOW (1<<29) 372 #define NV_TX_ERROR (1<<30) 373 #define NV_TX_VALID (1<<31) 374 375 #define NV_TX2_LASTPACKET (1<<29) 376 #define NV_TX2_RETRYERROR (1<<18) 377 #define NV_TX2_RETRYCOUNT_MASK (0xF<<19) 378 #define NV_TX2_FORCED_INTERRUPT (1<<30) 379 #define NV_TX2_DEFERRED (1<<25) 380 #define NV_TX2_CARRIERLOST (1<<26) 381 #define NV_TX2_LATECOLLISION (1<<27) 382 #define NV_TX2_UNDERFLOW (1<<28) 383 /* error and valid are the same for both */ 384 #define NV_TX2_ERROR (1<<30) 385 #define NV_TX2_VALID (1<<31) 386 #define NV_TX2_TSO (1<<28) 387 #define NV_TX2_TSO_SHIFT 14 388 #define NV_TX2_TSO_MAX_SHIFT 14 389 #define NV_TX2_TSO_MAX_SIZE (1<<NV_TX2_TSO_MAX_SHIFT) 390 #define NV_TX2_CHECKSUM_L3 (1<<27) 391 #define NV_TX2_CHECKSUM_L4 (1<<26) 392 393 #define NV_TX3_VLAN_TAG_PRESENT (1<<18) 394 395 #define NV_RX_DESCRIPTORVALID (1<<16) 396 #define NV_RX_MISSEDFRAME (1<<17) 397 #define NV_RX_SUBTRACT1 (1<<18) 398 #define NV_RX_ERROR1 (1<<23) 399 #define NV_RX_ERROR2 (1<<24) 400 #define NV_RX_ERROR3 (1<<25) 401 #define NV_RX_ERROR4 (1<<26) 402 #define NV_RX_CRCERR (1<<27) 403 #define NV_RX_OVERFLOW (1<<28) 404 #define NV_RX_FRAMINGERR (1<<29) 405 #define NV_RX_ERROR (1<<30) 406 #define NV_RX_AVAIL (1<<31) 407 #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) 408 409 #define NV_RX2_CHECKSUMMASK (0x1C000000) 410 #define NV_RX2_CHECKSUM_IP (0x10000000) 411 #define NV_RX2_CHECKSUM_IP_TCP (0x14000000) 412 #define NV_RX2_CHECKSUM_IP_UDP (0x18000000) 413 #define NV_RX2_DESCRIPTORVALID (1<<29) 414 #define NV_RX2_SUBTRACT1 (1<<25) 415 #define NV_RX2_ERROR1 (1<<18) 416 #define NV_RX2_ERROR2 (1<<19) 417 #define NV_RX2_ERROR3 (1<<20) 418 #define NV_RX2_ERROR4 (1<<21) 419 #define NV_RX2_CRCERR (1<<22) 420 #define NV_RX2_OVERFLOW (1<<23) 421 #define NV_RX2_FRAMINGERR (1<<24) 422 /* error and avail are the same for both */ 423 #define NV_RX2_ERROR (1<<30) 424 #define NV_RX2_AVAIL (1<<31) 425 #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) 426 427 #define NV_RX3_VLAN_TAG_PRESENT (1<<16) 428 #define NV_RX3_VLAN_TAG_MASK (0x0000FFFF) 429 430 /* Miscellaneous hardware related defines: */ 431 #define NV_PCI_REGSZ_VER1 0x270 432 #define NV_PCI_REGSZ_VER2 0x2d4 433 #define NV_PCI_REGSZ_VER3 0x604 434 #define NV_PCI_REGSZ_MAX 0x604 435 436 /* various timeout delays: all in usec */ 437 #define NV_TXRX_RESET_DELAY 4 438 #define NV_TXSTOP_DELAY1 10 439 #define NV_TXSTOP_DELAY1MAX 500000 440 #define NV_TXSTOP_DELAY2 100 441 #define NV_RXSTOP_DELAY1 10 442 #define NV_RXSTOP_DELAY1MAX 500000 443 #define NV_RXSTOP_DELAY2 100 444 #define NV_SETUP5_DELAY 5 445 #define NV_SETUP5_DELAYMAX 50000 446 #define NV_POWERUP_DELAY 5 447 #define NV_POWERUP_DELAYMAX 5000 448 #define NV_MIIBUSY_DELAY 50 449 #define NV_MIIPHY_DELAY 10 450 #define NV_MIIPHY_DELAYMAX 10000 451 #define NV_MAC_RESET_DELAY 64 452 453 #define NV_WAKEUPPATTERNS 5 454 #define NV_WAKEUPMASKENTRIES 4 455 456 /* General driver defaults */ 457 #define NV_WATCHDOG_TIMEO (5*HZ) 458 459 #define RX_RING_DEFAULT 512 460 #define TX_RING_DEFAULT 256 461 #define RX_RING_MIN 128 462 #define TX_RING_MIN 64 463 #define RING_MAX_DESC_VER_1 1024 464 #define RING_MAX_DESC_VER_2_3 16384 465 466 /* rx/tx mac addr + type + vlan + align + slack*/ 467 #define NV_RX_HEADERS (64) 468 /* even more slack. */ 469 #define NV_RX_ALLOC_PAD (64) 470 471 /* maximum mtu size */ 472 #define NV_PKTLIMIT_1 ETH_DATA_LEN /* hard limit not known */ 473 #define NV_PKTLIMIT_2 9100 /* Actual limit according to NVidia: 9202 */ 474 475 #define OOM_REFILL (1+HZ/20) 476 #define POLL_WAIT (1+HZ/100) 477 #define LINK_TIMEOUT (3*HZ) 478 #define STATS_INTERVAL (10*HZ) 479 480 /* 481 * desc_ver values: 482 * The nic supports three different descriptor types: 483 * - DESC_VER_1: Original 484 * - DESC_VER_2: support for jumbo frames. 485 * - DESC_VER_3: 64-bit format. 486 */ 487 #define DESC_VER_1 1 488 #define DESC_VER_2 2 489 #define DESC_VER_3 3 490 491 /* PHY defines */ 492 #define PHY_OUI_MARVELL 0x5043 493 #define PHY_OUI_CICADA 0x03f1 494 #define PHY_OUI_VITESSE 0x01c1 495 #define PHY_OUI_REALTEK 0x0732 496 #define PHY_OUI_REALTEK2 0x0020 497 #define PHYID1_OUI_MASK 0x03ff 498 #define PHYID1_OUI_SHFT 6 499 #define PHYID2_OUI_MASK 0xfc00 500 #define PHYID2_OUI_SHFT 10 501 #define PHYID2_MODEL_MASK 0x03f0 502 #define PHY_MODEL_REALTEK_8211 0x0110 503 #define PHY_REV_MASK 0x0001 504 #define PHY_REV_REALTEK_8211B 0x0000 505 #define PHY_REV_REALTEK_8211C 0x0001 506 #define PHY_MODEL_REALTEK_8201 0x0200 507 #define PHY_MODEL_MARVELL_E3016 0x0220 508 #define PHY_MARVELL_E3016_INITMASK 0x0300 509 #define PHY_CICADA_INIT1 0x0f000 510 #define PHY_CICADA_INIT2 0x0e00 511 #define PHY_CICADA_INIT3 0x01000 512 #define PHY_CICADA_INIT4 0x0200 513 #define PHY_CICADA_INIT5 0x0004 514 #define PHY_CICADA_INIT6 0x02000 515 #define PHY_VITESSE_INIT_REG1 0x1f 516 #define PHY_VITESSE_INIT_REG2 0x10 517 #define PHY_VITESSE_INIT_REG3 0x11 518 #define PHY_VITESSE_INIT_REG4 0x12 519 #define PHY_VITESSE_INIT_MSK1 0xc 520 #define PHY_VITESSE_INIT_MSK2 0x0180 521 #define PHY_VITESSE_INIT1 0x52b5 522 #define PHY_VITESSE_INIT2 0xaf8a 523 #define PHY_VITESSE_INIT3 0x8 524 #define PHY_VITESSE_INIT4 0x8f8a 525 #define PHY_VITESSE_INIT5 0xaf86 526 #define PHY_VITESSE_INIT6 0x8f86 527 #define PHY_VITESSE_INIT7 0xaf82 528 #define PHY_VITESSE_INIT8 0x0100 529 #define PHY_VITESSE_INIT9 0x8f82 530 #define PHY_VITESSE_INIT10 0x0 531 #define PHY_REALTEK_INIT_REG1 0x1f 532 #define PHY_REALTEK_INIT_REG2 0x19 533 #define PHY_REALTEK_INIT_REG3 0x13 534 #define PHY_REALTEK_INIT_REG4 0x14 535 #define PHY_REALTEK_INIT_REG5 0x18 536 #define PHY_REALTEK_INIT_REG6 0x11 537 #define PHY_REALTEK_INIT_REG7 0x01 538 #define PHY_REALTEK_INIT1 0x0000 539 #define PHY_REALTEK_INIT2 0x8e00 540 #define PHY_REALTEK_INIT3 0x0001 541 #define PHY_REALTEK_INIT4 0xad17 542 #define PHY_REALTEK_INIT5 0xfb54 543 #define PHY_REALTEK_INIT6 0xf5c7 544 #define PHY_REALTEK_INIT7 0x1000 545 #define PHY_REALTEK_INIT8 0x0003 546 #define PHY_REALTEK_INIT9 0x0008 547 #define PHY_REALTEK_INIT10 0x0005 548 #define PHY_REALTEK_INIT11 0x0200 549 #define PHY_REALTEK_INIT_MSK1 0x0003 550 551 #define PHY_GIGABIT 0x0100 552 553 #define PHY_TIMEOUT 0x1 554 #define PHY_ERROR 0x2 555 556 #define PHY_100 0x1 557 #define PHY_1000 0x2 558 #define PHY_HALF 0x100 559 560 #define NV_PAUSEFRAME_RX_CAPABLE 0x0001 561 #define NV_PAUSEFRAME_TX_CAPABLE 0x0002 562 #define NV_PAUSEFRAME_RX_ENABLE 0x0004 563 #define NV_PAUSEFRAME_TX_ENABLE 0x0008 564 #define NV_PAUSEFRAME_RX_REQ 0x0010 565 #define NV_PAUSEFRAME_TX_REQ 0x0020 566 #define NV_PAUSEFRAME_AUTONEG 0x0040 567 568 /* MSI/MSI-X defines */ 569 #define NV_MSI_X_MAX_VECTORS 8 570 #define NV_MSI_X_VECTORS_MASK 0x000f 571 #define NV_MSI_CAPABLE 0x0010 572 #define NV_MSI_X_CAPABLE 0x0020 573 #define NV_MSI_ENABLED 0x0040 574 #define NV_MSI_X_ENABLED 0x0080 575 576 #define NV_MSI_X_VECTOR_ALL 0x0 577 #define NV_MSI_X_VECTOR_RX 0x0 578 #define NV_MSI_X_VECTOR_TX 0x1 579 #define NV_MSI_X_VECTOR_OTHER 0x2 580 581 #define NV_MSI_PRIV_OFFSET 0x68 582 #define NV_MSI_PRIV_VALUE 0xffffffff 583 584 #define NV_RESTART_TX 0x1 585 #define NV_RESTART_RX 0x2 586 587 #define NV_TX_LIMIT_COUNT 16 588 589 #define NV_DYNAMIC_THRESHOLD 4 590 #define NV_DYNAMIC_MAX_QUIET_COUNT 2048 591 592 /* statistics */ 593 struct nv_ethtool_str { 594 char name[ETH_GSTRING_LEN]; 595 }; 596 597 static const struct nv_ethtool_str nv_estats_str[] = { 598 { "tx_bytes" }, /* includes Ethernet FCS CRC */ 599 { "tx_zero_rexmt" }, 600 { "tx_one_rexmt" }, 601 { "tx_many_rexmt" }, 602 { "tx_late_collision" }, 603 { "tx_fifo_errors" }, 604 { "tx_carrier_errors" }, 605 { "tx_excess_deferral" }, 606 { "tx_retry_error" }, 607 { "rx_frame_error" }, 608 { "rx_extra_byte" }, 609 { "rx_late_collision" }, 610 { "rx_runt" }, 611 { "rx_frame_too_long" }, 612 { "rx_over_errors" }, 613 { "rx_crc_errors" }, 614 { "rx_frame_align_error" }, 615 { "rx_length_error" }, 616 { "rx_unicast" }, 617 { "rx_multicast" }, 618 { "rx_broadcast" }, 619 { "rx_packets" }, 620 { "rx_errors_total" }, 621 { "tx_errors_total" }, 622 623 /* version 2 stats */ 624 { "tx_deferral" }, 625 { "tx_packets" }, 626 { "rx_bytes" }, /* includes Ethernet FCS CRC */ 627 { "tx_pause" }, 628 { "rx_pause" }, 629 { "rx_drop_frame" }, 630 631 /* version 3 stats */ 632 { "tx_unicast" }, 633 { "tx_multicast" }, 634 { "tx_broadcast" } 635 }; 636 637 struct nv_ethtool_stats { 638 u64 tx_bytes; /* should be ifconfig->tx_bytes + 4*tx_packets */ 639 u64 tx_zero_rexmt; 640 u64 tx_one_rexmt; 641 u64 tx_many_rexmt; 642 u64 tx_late_collision; 643 u64 tx_fifo_errors; 644 u64 tx_carrier_errors; 645 u64 tx_excess_deferral; 646 u64 tx_retry_error; 647 u64 rx_frame_error; 648 u64 rx_extra_byte; 649 u64 rx_late_collision; 650 u64 rx_runt; 651 u64 rx_frame_too_long; 652 u64 rx_over_errors; 653 u64 rx_crc_errors; 654 u64 rx_frame_align_error; 655 u64 rx_length_error; 656 u64 rx_unicast; 657 u64 rx_multicast; 658 u64 rx_broadcast; 659 u64 rx_packets; /* should be ifconfig->rx_packets */ 660 u64 rx_errors_total; 661 u64 tx_errors_total; 662 663 /* version 2 stats */ 664 u64 tx_deferral; 665 u64 tx_packets; /* should be ifconfig->tx_packets */ 666 u64 rx_bytes; /* should be ifconfig->rx_bytes + 4*rx_packets */ 667 u64 tx_pause; 668 u64 rx_pause; 669 u64 rx_drop_frame; 670 671 /* version 3 stats */ 672 u64 tx_unicast; 673 u64 tx_multicast; 674 u64 tx_broadcast; 675 }; 676 677 #define NV_DEV_STATISTICS_V3_COUNT (sizeof(struct nv_ethtool_stats)/sizeof(u64)) 678 #define NV_DEV_STATISTICS_V2_COUNT (NV_DEV_STATISTICS_V3_COUNT - 3) 679 #define NV_DEV_STATISTICS_V1_COUNT (NV_DEV_STATISTICS_V2_COUNT - 6) 680 681 /* diagnostics */ 682 #define NV_TEST_COUNT_BASE 3 683 #define NV_TEST_COUNT_EXTENDED 4 684 685 static const struct nv_ethtool_str nv_etests_str[] = { 686 { "link (online/offline)" }, 687 { "register (offline) " }, 688 { "interrupt (offline) " }, 689 { "loopback (offline) " } 690 }; 691 692 struct register_test { 693 __u32 reg; 694 __u32 mask; 695 }; 696 697 static const struct register_test nv_registers_test[] = { 698 { NvRegUnknownSetupReg6, 0x01 }, 699 { NvRegMisc1, 0x03c }, 700 { NvRegOffloadConfig, 0x03ff }, 701 { NvRegMulticastAddrA, 0xffffffff }, 702 { NvRegTxWatermark, 0x0ff }, 703 { NvRegWakeUpFlags, 0x07777 }, 704 { 0, 0 } 705 }; 706 707 struct nv_skb_map { 708 struct sk_buff *skb; 709 dma_addr_t dma; 710 unsigned int dma_len:31; 711 unsigned int dma_single:1; 712 struct ring_desc_ex *first_tx_desc; 713 struct nv_skb_map *next_tx_ctx; 714 }; 715 716 struct nv_txrx_stats { 717 u64 stat_rx_packets; 718 u64 stat_rx_bytes; /* not always available in HW */ 719 u64 stat_rx_missed_errors; 720 u64 stat_rx_dropped; 721 u64 stat_tx_packets; /* not always available in HW */ 722 u64 stat_tx_bytes; 723 u64 stat_tx_dropped; 724 }; 725 726 #define nv_txrx_stats_inc(member) \ 727 __this_cpu_inc(np->txrx_stats->member) 728 #define nv_txrx_stats_add(member, count) \ 729 __this_cpu_add(np->txrx_stats->member, (count)) 730 731 /* 732 * SMP locking: 733 * All hardware access under netdev_priv(dev)->lock, except the performance 734 * critical parts: 735 * - rx is (pseudo-) lockless: it relies on the single-threading provided 736 * by the arch code for interrupts. 737 * - tx setup is lockless: it relies on netif_tx_lock. Actual submission 738 * needs netdev_priv(dev)->lock :-( 739 * - set_multicast_list: preparation lockless, relies on netif_tx_lock. 740 * 741 * Hardware stats updates are protected by hwstats_lock: 742 * - updated by nv_do_stats_poll (timer). This is meant to avoid 743 * integer wraparound in the NIC stats registers, at low frequency 744 * (0.1 Hz) 745 * - updated by nv_get_ethtool_stats + nv_get_stats64 746 * 747 * Software stats are accessed only through 64b synchronization points 748 * and are not subject to other synchronization techniques (single 749 * update thread on the TX or RX paths). 750 */ 751 752 /* in dev: base, irq */ 753 struct fe_priv { 754 spinlock_t lock; 755 756 struct net_device *dev; 757 struct napi_struct napi; 758 759 /* hardware stats are updated in syscall and timer */ 760 spinlock_t hwstats_lock; 761 struct nv_ethtool_stats estats; 762 763 int in_shutdown; 764 u32 linkspeed; 765 int duplex; 766 int autoneg; 767 int fixed_mode; 768 int phyaddr; 769 int wolenabled; 770 unsigned int phy_oui; 771 unsigned int phy_model; 772 unsigned int phy_rev; 773 u16 gigabit; 774 int intr_test; 775 int recover_error; 776 int quiet_count; 777 778 /* General data: RO fields */ 779 dma_addr_t ring_addr; 780 struct pci_dev *pci_dev; 781 u32 orig_mac[2]; 782 u32 events; 783 u32 irqmask; 784 u32 desc_ver; 785 u32 txrxctl_bits; 786 u32 vlanctl_bits; 787 u32 driver_data; 788 u32 device_id; 789 u32 register_size; 790 u32 mac_in_use; 791 int mgmt_version; 792 int mgmt_sema; 793 794 void __iomem *base; 795 796 /* rx specific fields. 797 * Locking: Within irq hander or disable_irq+spin_lock(&np->lock); 798 */ 799 union ring_type get_rx, put_rx, last_rx; 800 struct nv_skb_map *get_rx_ctx, *put_rx_ctx; 801 struct nv_skb_map *last_rx_ctx; 802 struct nv_skb_map *rx_skb; 803 804 union ring_type rx_ring; 805 unsigned int rx_buf_sz; 806 unsigned int pkt_limit; 807 struct timer_list oom_kick; 808 struct timer_list nic_poll; 809 struct timer_list stats_poll; 810 u32 nic_poll_irq; 811 int rx_ring_size; 812 813 /* RX software stats */ 814 struct u64_stats_sync swstats_rx_syncp; 815 struct nv_txrx_stats __percpu *txrx_stats; 816 817 /* media detection workaround. 818 * Locking: Within irq hander or disable_irq+spin_lock(&np->lock); 819 */ 820 int need_linktimer; 821 unsigned long link_timeout; 822 /* 823 * tx specific fields. 824 */ 825 union ring_type get_tx, put_tx, last_tx; 826 struct nv_skb_map *get_tx_ctx, *put_tx_ctx; 827 struct nv_skb_map *last_tx_ctx; 828 struct nv_skb_map *tx_skb; 829 830 union ring_type tx_ring; 831 u32 tx_flags; 832 int tx_ring_size; 833 int tx_limit; 834 u32 tx_pkts_in_progress; 835 struct nv_skb_map *tx_change_owner; 836 struct nv_skb_map *tx_end_flip; 837 int tx_stop; 838 839 /* TX software stats */ 840 struct u64_stats_sync swstats_tx_syncp; 841 842 /* msi/msi-x fields */ 843 u32 msi_flags; 844 struct msix_entry msi_x_entry[NV_MSI_X_MAX_VECTORS]; 845 846 /* flow control */ 847 u32 pause_flags; 848 849 /* power saved state */ 850 u32 saved_config_space[NV_PCI_REGSZ_MAX/4]; 851 852 /* for different msi-x irq type */ 853 char name_rx[IFNAMSIZ + 3]; /* -rx */ 854 char name_tx[IFNAMSIZ + 3]; /* -tx */ 855 char name_other[IFNAMSIZ + 6]; /* -other */ 856 }; 857 858 /* 859 * Maximum number of loops until we assume that a bit in the irq mask 860 * is stuck. Overridable with module param. 861 */ 862 static int max_interrupt_work = 4; 863 864 /* 865 * Optimization can be either throuput mode or cpu mode 866 * 867 * Throughput Mode: Every tx and rx packet will generate an interrupt. 868 * CPU Mode: Interrupts are controlled by a timer. 869 */ 870 enum { 871 NV_OPTIMIZATION_MODE_THROUGHPUT, 872 NV_OPTIMIZATION_MODE_CPU, 873 NV_OPTIMIZATION_MODE_DYNAMIC 874 }; 875 static int optimization_mode = NV_OPTIMIZATION_MODE_DYNAMIC; 876 877 /* 878 * Poll interval for timer irq 879 * 880 * This interval determines how frequent an interrupt is generated. 881 * The is value is determined by [(time_in_micro_secs * 100) / (2^10)] 882 * Min = 0, and Max = 65535 883 */ 884 static int poll_interval = -1; 885 886 /* 887 * MSI interrupts 888 */ 889 enum { 890 NV_MSI_INT_DISABLED, 891 NV_MSI_INT_ENABLED 892 }; 893 static int msi = NV_MSI_INT_ENABLED; 894 895 /* 896 * MSIX interrupts 897 */ 898 enum { 899 NV_MSIX_INT_DISABLED, 900 NV_MSIX_INT_ENABLED 901 }; 902 static int msix = NV_MSIX_INT_ENABLED; 903 904 /* 905 * DMA 64bit 906 */ 907 enum { 908 NV_DMA_64BIT_DISABLED, 909 NV_DMA_64BIT_ENABLED 910 }; 911 static int dma_64bit = NV_DMA_64BIT_ENABLED; 912 913 /* 914 * Debug output control for tx_timeout 915 */ 916 static bool debug_tx_timeout = false; 917 918 /* 919 * Crossover Detection 920 * Realtek 8201 phy + some OEM boards do not work properly. 921 */ 922 enum { 923 NV_CROSSOVER_DETECTION_DISABLED, 924 NV_CROSSOVER_DETECTION_ENABLED 925 }; 926 static int phy_cross = NV_CROSSOVER_DETECTION_DISABLED; 927 928 /* 929 * Power down phy when interface is down (persists through reboot; 930 * older Linux and other OSes may not power it up again) 931 */ 932 static int phy_power_down; 933 934 static inline struct fe_priv *get_nvpriv(struct net_device *dev) 935 { 936 return netdev_priv(dev); 937 } 938 939 static inline u8 __iomem *get_hwbase(struct net_device *dev) 940 { 941 return ((struct fe_priv *)netdev_priv(dev))->base; 942 } 943 944 static inline void pci_push(u8 __iomem *base) 945 { 946 /* force out pending posted writes */ 947 readl(base); 948 } 949 950 static inline u32 nv_descr_getlength(struct ring_desc *prd, u32 v) 951 { 952 return le32_to_cpu(prd->flaglen) 953 & ((v == DESC_VER_1) ? LEN_MASK_V1 : LEN_MASK_V2); 954 } 955 956 static inline u32 nv_descr_getlength_ex(struct ring_desc_ex *prd, u32 v) 957 { 958 return le32_to_cpu(prd->flaglen) & LEN_MASK_V2; 959 } 960 961 static bool nv_optimized(struct fe_priv *np) 962 { 963 if (np->desc_ver == DESC_VER_1 || np->desc_ver == DESC_VER_2) 964 return false; 965 return true; 966 } 967 968 static int reg_delay(struct net_device *dev, int offset, u32 mask, u32 target, 969 int delay, int delaymax) 970 { 971 u8 __iomem *base = get_hwbase(dev); 972 973 pci_push(base); 974 do { 975 udelay(delay); 976 delaymax -= delay; 977 if (delaymax < 0) 978 return 1; 979 } while ((readl(base + offset) & mask) != target); 980 return 0; 981 } 982 983 #define NV_SETUP_RX_RING 0x01 984 #define NV_SETUP_TX_RING 0x02 985 986 static inline u32 dma_low(dma_addr_t addr) 987 { 988 return addr; 989 } 990 991 static inline u32 dma_high(dma_addr_t addr) 992 { 993 return addr>>31>>1; /* 0 if 32bit, shift down by 32 if 64bit */ 994 } 995 996 static void setup_hw_rings(struct net_device *dev, int rxtx_flags) 997 { 998 struct fe_priv *np = get_nvpriv(dev); 999 u8 __iomem *base = get_hwbase(dev); 1000 1001 if (!nv_optimized(np)) { 1002 if (rxtx_flags & NV_SETUP_RX_RING) 1003 writel(dma_low(np->ring_addr), base + NvRegRxRingPhysAddr); 1004 if (rxtx_flags & NV_SETUP_TX_RING) 1005 writel(dma_low(np->ring_addr + np->rx_ring_size*sizeof(struct ring_desc)), base + NvRegTxRingPhysAddr); 1006 } else { 1007 if (rxtx_flags & NV_SETUP_RX_RING) { 1008 writel(dma_low(np->ring_addr), base + NvRegRxRingPhysAddr); 1009 writel(dma_high(np->ring_addr), base + NvRegRxRingPhysAddrHigh); 1010 } 1011 if (rxtx_flags & NV_SETUP_TX_RING) { 1012 writel(dma_low(np->ring_addr + np->rx_ring_size*sizeof(struct ring_desc_ex)), base + NvRegTxRingPhysAddr); 1013 writel(dma_high(np->ring_addr + np->rx_ring_size*sizeof(struct ring_desc_ex)), base + NvRegTxRingPhysAddrHigh); 1014 } 1015 } 1016 } 1017 1018 static void free_rings(struct net_device *dev) 1019 { 1020 struct fe_priv *np = get_nvpriv(dev); 1021 1022 if (!nv_optimized(np)) { 1023 if (np->rx_ring.orig) 1024 dma_free_coherent(&np->pci_dev->dev, 1025 sizeof(struct ring_desc) * 1026 (np->rx_ring_size + 1027 np->tx_ring_size), 1028 np->rx_ring.orig, np->ring_addr); 1029 } else { 1030 if (np->rx_ring.ex) 1031 dma_free_coherent(&np->pci_dev->dev, 1032 sizeof(struct ring_desc_ex) * 1033 (np->rx_ring_size + 1034 np->tx_ring_size), 1035 np->rx_ring.ex, np->ring_addr); 1036 } 1037 kfree(np->rx_skb); 1038 kfree(np->tx_skb); 1039 } 1040 1041 static int using_multi_irqs(struct net_device *dev) 1042 { 1043 struct fe_priv *np = get_nvpriv(dev); 1044 1045 if (!(np->msi_flags & NV_MSI_X_ENABLED) || 1046 ((np->msi_flags & NV_MSI_X_ENABLED) && 1047 ((np->msi_flags & NV_MSI_X_VECTORS_MASK) == 0x1))) 1048 return 0; 1049 else 1050 return 1; 1051 } 1052 1053 static void nv_txrx_gate(struct net_device *dev, bool gate) 1054 { 1055 struct fe_priv *np = get_nvpriv(dev); 1056 u8 __iomem *base = get_hwbase(dev); 1057 u32 powerstate; 1058 1059 if (!np->mac_in_use && 1060 (np->driver_data & DEV_HAS_POWER_CNTRL)) { 1061 powerstate = readl(base + NvRegPowerState2); 1062 if (gate) 1063 powerstate |= NVREG_POWERSTATE2_GATE_CLOCKS; 1064 else 1065 powerstate &= ~NVREG_POWERSTATE2_GATE_CLOCKS; 1066 writel(powerstate, base + NvRegPowerState2); 1067 } 1068 } 1069 1070 static void nv_enable_irq(struct net_device *dev) 1071 { 1072 struct fe_priv *np = get_nvpriv(dev); 1073 1074 if (!using_multi_irqs(dev)) { 1075 if (np->msi_flags & NV_MSI_X_ENABLED) 1076 enable_irq(np->msi_x_entry[NV_MSI_X_VECTOR_ALL].vector); 1077 else 1078 enable_irq(np->pci_dev->irq); 1079 } else { 1080 enable_irq(np->msi_x_entry[NV_MSI_X_VECTOR_RX].vector); 1081 enable_irq(np->msi_x_entry[NV_MSI_X_VECTOR_TX].vector); 1082 enable_irq(np->msi_x_entry[NV_MSI_X_VECTOR_OTHER].vector); 1083 } 1084 } 1085 1086 static void nv_disable_irq(struct net_device *dev) 1087 { 1088 struct fe_priv *np = get_nvpriv(dev); 1089 1090 if (!using_multi_irqs(dev)) { 1091 if (np->msi_flags & NV_MSI_X_ENABLED) 1092 disable_irq(np->msi_x_entry[NV_MSI_X_VECTOR_ALL].vector); 1093 else 1094 disable_irq(np->pci_dev->irq); 1095 } else { 1096 disable_irq(np->msi_x_entry[NV_MSI_X_VECTOR_RX].vector); 1097 disable_irq(np->msi_x_entry[NV_MSI_X_VECTOR_TX].vector); 1098 disable_irq(np->msi_x_entry[NV_MSI_X_VECTOR_OTHER].vector); 1099 } 1100 } 1101 1102 /* In MSIX mode, a write to irqmask behaves as XOR */ 1103 static void nv_enable_hw_interrupts(struct net_device *dev, u32 mask) 1104 { 1105 u8 __iomem *base = get_hwbase(dev); 1106 1107 writel(mask, base + NvRegIrqMask); 1108 } 1109 1110 static void nv_disable_hw_interrupts(struct net_device *dev, u32 mask) 1111 { 1112 struct fe_priv *np = get_nvpriv(dev); 1113 u8 __iomem *base = get_hwbase(dev); 1114 1115 if (np->msi_flags & NV_MSI_X_ENABLED) { 1116 writel(mask, base + NvRegIrqMask); 1117 } else { 1118 if (np->msi_flags & NV_MSI_ENABLED) 1119 writel(0, base + NvRegMSIIrqMask); 1120 writel(0, base + NvRegIrqMask); 1121 } 1122 } 1123 1124 static void nv_napi_enable(struct net_device *dev) 1125 { 1126 struct fe_priv *np = get_nvpriv(dev); 1127 1128 napi_enable(&np->napi); 1129 } 1130 1131 static void nv_napi_disable(struct net_device *dev) 1132 { 1133 struct fe_priv *np = get_nvpriv(dev); 1134 1135 napi_disable(&np->napi); 1136 } 1137 1138 #define MII_READ (-1) 1139 /* mii_rw: read/write a register on the PHY. 1140 * 1141 * Caller must guarantee serialization 1142 */ 1143 static int mii_rw(struct net_device *dev, int addr, int miireg, int value) 1144 { 1145 u8 __iomem *base = get_hwbase(dev); 1146 u32 reg; 1147 int retval; 1148 1149 writel(NVREG_MIISTAT_MASK_RW, base + NvRegMIIStatus); 1150 1151 reg = readl(base + NvRegMIIControl); 1152 if (reg & NVREG_MIICTL_INUSE) { 1153 writel(NVREG_MIICTL_INUSE, base + NvRegMIIControl); 1154 udelay(NV_MIIBUSY_DELAY); 1155 } 1156 1157 reg = (addr << NVREG_MIICTL_ADDRSHIFT) | miireg; 1158 if (value != MII_READ) { 1159 writel(value, base + NvRegMIIData); 1160 reg |= NVREG_MIICTL_WRITE; 1161 } 1162 writel(reg, base + NvRegMIIControl); 1163 1164 if (reg_delay(dev, NvRegMIIControl, NVREG_MIICTL_INUSE, 0, 1165 NV_MIIPHY_DELAY, NV_MIIPHY_DELAYMAX)) { 1166 retval = -1; 1167 } else if (value != MII_READ) { 1168 /* it was a write operation - fewer failures are detectable */ 1169 retval = 0; 1170 } else if (readl(base + NvRegMIIStatus) & NVREG_MIISTAT_ERROR) { 1171 retval = -1; 1172 } else { 1173 retval = readl(base + NvRegMIIData); 1174 } 1175 1176 return retval; 1177 } 1178 1179 static int phy_reset(struct net_device *dev, u32 bmcr_setup) 1180 { 1181 struct fe_priv *np = netdev_priv(dev); 1182 u32 miicontrol; 1183 unsigned int tries = 0; 1184 1185 miicontrol = BMCR_RESET | bmcr_setup; 1186 if (mii_rw(dev, np->phyaddr, MII_BMCR, miicontrol)) 1187 return -1; 1188 1189 /* wait for 500ms */ 1190 msleep(500); 1191 1192 /* must wait till reset is deasserted */ 1193 while (miicontrol & BMCR_RESET) { 1194 usleep_range(10000, 20000); 1195 miicontrol = mii_rw(dev, np->phyaddr, MII_BMCR, MII_READ); 1196 /* FIXME: 100 tries seem excessive */ 1197 if (tries++ > 100) 1198 return -1; 1199 } 1200 return 0; 1201 } 1202 1203 static int init_realtek_8211b(struct net_device *dev, struct fe_priv *np) 1204 { 1205 static const struct { 1206 int reg; 1207 int init; 1208 } ri[] = { 1209 { PHY_REALTEK_INIT_REG1, PHY_REALTEK_INIT1 }, 1210 { PHY_REALTEK_INIT_REG2, PHY_REALTEK_INIT2 }, 1211 { PHY_REALTEK_INIT_REG1, PHY_REALTEK_INIT3 }, 1212 { PHY_REALTEK_INIT_REG3, PHY_REALTEK_INIT4 }, 1213 { PHY_REALTEK_INIT_REG4, PHY_REALTEK_INIT5 }, 1214 { PHY_REALTEK_INIT_REG5, PHY_REALTEK_INIT6 }, 1215 { PHY_REALTEK_INIT_REG1, PHY_REALTEK_INIT1 }, 1216 }; 1217 int i; 1218 1219 for (i = 0; i < ARRAY_SIZE(ri); i++) { 1220 if (mii_rw(dev, np->phyaddr, ri[i].reg, ri[i].init)) 1221 return PHY_ERROR; 1222 } 1223 1224 return 0; 1225 } 1226 1227 static int init_realtek_8211c(struct net_device *dev, struct fe_priv *np) 1228 { 1229 u32 reg; 1230 u8 __iomem *base = get_hwbase(dev); 1231 u32 powerstate = readl(base + NvRegPowerState2); 1232 1233 /* need to perform hw phy reset */ 1234 powerstate |= NVREG_POWERSTATE2_PHY_RESET; 1235 writel(powerstate, base + NvRegPowerState2); 1236 msleep(25); 1237 1238 powerstate &= ~NVREG_POWERSTATE2_PHY_RESET; 1239 writel(powerstate, base + NvRegPowerState2); 1240 msleep(25); 1241 1242 reg = mii_rw(dev, np->phyaddr, PHY_REALTEK_INIT_REG6, MII_READ); 1243 reg |= PHY_REALTEK_INIT9; 1244 if (mii_rw(dev, np->phyaddr, PHY_REALTEK_INIT_REG6, reg)) 1245 return PHY_ERROR; 1246 if (mii_rw(dev, np->phyaddr, 1247 PHY_REALTEK_INIT_REG1, PHY_REALTEK_INIT10)) 1248 return PHY_ERROR; 1249 reg = mii_rw(dev, np->phyaddr, PHY_REALTEK_INIT_REG7, MII_READ); 1250 if (!(reg & PHY_REALTEK_INIT11)) { 1251 reg |= PHY_REALTEK_INIT11; 1252 if (mii_rw(dev, np->phyaddr, PHY_REALTEK_INIT_REG7, reg)) 1253 return PHY_ERROR; 1254 } 1255 if (mii_rw(dev, np->phyaddr, 1256 PHY_REALTEK_INIT_REG1, PHY_REALTEK_INIT1)) 1257 return PHY_ERROR; 1258 1259 return 0; 1260 } 1261 1262 static int init_realtek_8201(struct net_device *dev, struct fe_priv *np) 1263 { 1264 u32 phy_reserved; 1265 1266 if (np->driver_data & DEV_NEED_PHY_INIT_FIX) { 1267 phy_reserved = mii_rw(dev, np->phyaddr, 1268 PHY_REALTEK_INIT_REG6, MII_READ); 1269 phy_reserved |= PHY_REALTEK_INIT7; 1270 if (mii_rw(dev, np->phyaddr, 1271 PHY_REALTEK_INIT_REG6, phy_reserved)) 1272 return PHY_ERROR; 1273 } 1274 1275 return 0; 1276 } 1277 1278 static int init_realtek_8201_cross(struct net_device *dev, struct fe_priv *np) 1279 { 1280 u32 phy_reserved; 1281 1282 if (phy_cross == NV_CROSSOVER_DETECTION_DISABLED) { 1283 if (mii_rw(dev, np->phyaddr, 1284 PHY_REALTEK_INIT_REG1, PHY_REALTEK_INIT3)) 1285 return PHY_ERROR; 1286 phy_reserved = mii_rw(dev, np->phyaddr, 1287 PHY_REALTEK_INIT_REG2, MII_READ); 1288 phy_reserved &= ~PHY_REALTEK_INIT_MSK1; 1289 phy_reserved |= PHY_REALTEK_INIT3; 1290 if (mii_rw(dev, np->phyaddr, 1291 PHY_REALTEK_INIT_REG2, phy_reserved)) 1292 return PHY_ERROR; 1293 if (mii_rw(dev, np->phyaddr, 1294 PHY_REALTEK_INIT_REG1, PHY_REALTEK_INIT1)) 1295 return PHY_ERROR; 1296 } 1297 1298 return 0; 1299 } 1300 1301 static int init_cicada(struct net_device *dev, struct fe_priv *np, 1302 u32 phyinterface) 1303 { 1304 u32 phy_reserved; 1305 1306 if (phyinterface & PHY_RGMII) { 1307 phy_reserved = mii_rw(dev, np->phyaddr, MII_RESV1, MII_READ); 1308 phy_reserved &= ~(PHY_CICADA_INIT1 | PHY_CICADA_INIT2); 1309 phy_reserved |= (PHY_CICADA_INIT3 | PHY_CICADA_INIT4); 1310 if (mii_rw(dev, np->phyaddr, MII_RESV1, phy_reserved)) 1311 return PHY_ERROR; 1312 phy_reserved = mii_rw(dev, np->phyaddr, MII_NCONFIG, MII_READ); 1313 phy_reserved |= PHY_CICADA_INIT5; 1314 if (mii_rw(dev, np->phyaddr, MII_NCONFIG, phy_reserved)) 1315 return PHY_ERROR; 1316 } 1317 phy_reserved = mii_rw(dev, np->phyaddr, MII_SREVISION, MII_READ); 1318 phy_reserved |= PHY_CICADA_INIT6; 1319 if (mii_rw(dev, np->phyaddr, MII_SREVISION, phy_reserved)) 1320 return PHY_ERROR; 1321 1322 return 0; 1323 } 1324 1325 static int init_vitesse(struct net_device *dev, struct fe_priv *np) 1326 { 1327 u32 phy_reserved; 1328 1329 if (mii_rw(dev, np->phyaddr, 1330 PHY_VITESSE_INIT_REG1, PHY_VITESSE_INIT1)) 1331 return PHY_ERROR; 1332 if (mii_rw(dev, np->phyaddr, 1333 PHY_VITESSE_INIT_REG2, PHY_VITESSE_INIT2)) 1334 return PHY_ERROR; 1335 phy_reserved = mii_rw(dev, np->phyaddr, 1336 PHY_VITESSE_INIT_REG4, MII_READ); 1337 if (mii_rw(dev, np->phyaddr, PHY_VITESSE_INIT_REG4, phy_reserved)) 1338 return PHY_ERROR; 1339 phy_reserved = mii_rw(dev, np->phyaddr, 1340 PHY_VITESSE_INIT_REG3, MII_READ); 1341 phy_reserved &= ~PHY_VITESSE_INIT_MSK1; 1342 phy_reserved |= PHY_VITESSE_INIT3; 1343 if (mii_rw(dev, np->phyaddr, PHY_VITESSE_INIT_REG3, phy_reserved)) 1344 return PHY_ERROR; 1345 if (mii_rw(dev, np->phyaddr, 1346 PHY_VITESSE_INIT_REG2, PHY_VITESSE_INIT4)) 1347 return PHY_ERROR; 1348 if (mii_rw(dev, np->phyaddr, 1349 PHY_VITESSE_INIT_REG2, PHY_VITESSE_INIT5)) 1350 return PHY_ERROR; 1351 phy_reserved = mii_rw(dev, np->phyaddr, 1352 PHY_VITESSE_INIT_REG4, MII_READ); 1353 phy_reserved &= ~PHY_VITESSE_INIT_MSK1; 1354 phy_reserved |= PHY_VITESSE_INIT3; 1355 if (mii_rw(dev, np->phyaddr, PHY_VITESSE_INIT_REG4, phy_reserved)) 1356 return PHY_ERROR; 1357 phy_reserved = mii_rw(dev, np->phyaddr, 1358 PHY_VITESSE_INIT_REG3, MII_READ); 1359 if (mii_rw(dev, np->phyaddr, PHY_VITESSE_INIT_REG3, phy_reserved)) 1360 return PHY_ERROR; 1361 if (mii_rw(dev, np->phyaddr, 1362 PHY_VITESSE_INIT_REG2, PHY_VITESSE_INIT6)) 1363 return PHY_ERROR; 1364 if (mii_rw(dev, np->phyaddr, 1365 PHY_VITESSE_INIT_REG2, PHY_VITESSE_INIT7)) 1366 return PHY_ERROR; 1367 phy_reserved = mii_rw(dev, np->phyaddr, 1368 PHY_VITESSE_INIT_REG4, MII_READ); 1369 if (mii_rw(dev, np->phyaddr, PHY_VITESSE_INIT_REG4, phy_reserved)) 1370 return PHY_ERROR; 1371 phy_reserved = mii_rw(dev, np->phyaddr, 1372 PHY_VITESSE_INIT_REG3, MII_READ); 1373 phy_reserved &= ~PHY_VITESSE_INIT_MSK2; 1374 phy_reserved |= PHY_VITESSE_INIT8; 1375 if (mii_rw(dev, np->phyaddr, PHY_VITESSE_INIT_REG3, phy_reserved)) 1376 return PHY_ERROR; 1377 if (mii_rw(dev, np->phyaddr, 1378 PHY_VITESSE_INIT_REG2, PHY_VITESSE_INIT9)) 1379 return PHY_ERROR; 1380 if (mii_rw(dev, np->phyaddr, 1381 PHY_VITESSE_INIT_REG1, PHY_VITESSE_INIT10)) 1382 return PHY_ERROR; 1383 1384 return 0; 1385 } 1386 1387 static int phy_init(struct net_device *dev) 1388 { 1389 struct fe_priv *np = get_nvpriv(dev); 1390 u8 __iomem *base = get_hwbase(dev); 1391 u32 phyinterface; 1392 u32 mii_status, mii_control, mii_control_1000, reg; 1393 1394 /* phy errata for E3016 phy */ 1395 if (np->phy_model == PHY_MODEL_MARVELL_E3016) { 1396 reg = mii_rw(dev, np->phyaddr, MII_NCONFIG, MII_READ); 1397 reg &= ~PHY_MARVELL_E3016_INITMASK; 1398 if (mii_rw(dev, np->phyaddr, MII_NCONFIG, reg)) { 1399 netdev_info(dev, "%s: phy write to errata reg failed\n", 1400 pci_name(np->pci_dev)); 1401 return PHY_ERROR; 1402 } 1403 } 1404 if (np->phy_oui == PHY_OUI_REALTEK) { 1405 if (np->phy_model == PHY_MODEL_REALTEK_8211 && 1406 np->phy_rev == PHY_REV_REALTEK_8211B) { 1407 if (init_realtek_8211b(dev, np)) { 1408 netdev_info(dev, "%s: phy init failed\n", 1409 pci_name(np->pci_dev)); 1410 return PHY_ERROR; 1411 } 1412 } else if (np->phy_model == PHY_MODEL_REALTEK_8211 && 1413 np->phy_rev == PHY_REV_REALTEK_8211C) { 1414 if (init_realtek_8211c(dev, np)) { 1415 netdev_info(dev, "%s: phy init failed\n", 1416 pci_name(np->pci_dev)); 1417 return PHY_ERROR; 1418 } 1419 } else if (np->phy_model == PHY_MODEL_REALTEK_8201) { 1420 if (init_realtek_8201(dev, np)) { 1421 netdev_info(dev, "%s: phy init failed\n", 1422 pci_name(np->pci_dev)); 1423 return PHY_ERROR; 1424 } 1425 } 1426 } 1427 1428 /* set advertise register */ 1429 reg = mii_rw(dev, np->phyaddr, MII_ADVERTISE, MII_READ); 1430 reg |= (ADVERTISE_10HALF | ADVERTISE_10FULL | 1431 ADVERTISE_100HALF | ADVERTISE_100FULL | 1432 ADVERTISE_PAUSE_ASYM | ADVERTISE_PAUSE_CAP); 1433 if (mii_rw(dev, np->phyaddr, MII_ADVERTISE, reg)) { 1434 netdev_info(dev, "%s: phy write to advertise failed\n", 1435 pci_name(np->pci_dev)); 1436 return PHY_ERROR; 1437 } 1438 1439 /* get phy interface type */ 1440 phyinterface = readl(base + NvRegPhyInterface); 1441 1442 /* see if gigabit phy */ 1443 mii_status = mii_rw(dev, np->phyaddr, MII_BMSR, MII_READ); 1444 if (mii_status & PHY_GIGABIT) { 1445 np->gigabit = PHY_GIGABIT; 1446 mii_control_1000 = mii_rw(dev, np->phyaddr, 1447 MII_CTRL1000, MII_READ); 1448 mii_control_1000 &= ~ADVERTISE_1000HALF; 1449 if (phyinterface & PHY_RGMII) 1450 mii_control_1000 |= ADVERTISE_1000FULL; 1451 else 1452 mii_control_1000 &= ~ADVERTISE_1000FULL; 1453 1454 if (mii_rw(dev, np->phyaddr, MII_CTRL1000, mii_control_1000)) { 1455 netdev_info(dev, "%s: phy init failed\n", 1456 pci_name(np->pci_dev)); 1457 return PHY_ERROR; 1458 } 1459 } else 1460 np->gigabit = 0; 1461 1462 mii_control = mii_rw(dev, np->phyaddr, MII_BMCR, MII_READ); 1463 mii_control |= BMCR_ANENABLE; 1464 1465 if (np->phy_oui == PHY_OUI_REALTEK && 1466 np->phy_model == PHY_MODEL_REALTEK_8211 && 1467 np->phy_rev == PHY_REV_REALTEK_8211C) { 1468 /* start autoneg since we already performed hw reset above */ 1469 mii_control |= BMCR_ANRESTART; 1470 if (mii_rw(dev, np->phyaddr, MII_BMCR, mii_control)) { 1471 netdev_info(dev, "%s: phy init failed\n", 1472 pci_name(np->pci_dev)); 1473 return PHY_ERROR; 1474 } 1475 } else { 1476 /* reset the phy 1477 * (certain phys need bmcr to be setup with reset) 1478 */ 1479 if (phy_reset(dev, mii_control)) { 1480 netdev_info(dev, "%s: phy reset failed\n", 1481 pci_name(np->pci_dev)); 1482 return PHY_ERROR; 1483 } 1484 } 1485 1486 /* phy vendor specific configuration */ 1487 if (np->phy_oui == PHY_OUI_CICADA) { 1488 if (init_cicada(dev, np, phyinterface)) { 1489 netdev_info(dev, "%s: phy init failed\n", 1490 pci_name(np->pci_dev)); 1491 return PHY_ERROR; 1492 } 1493 } else if (np->phy_oui == PHY_OUI_VITESSE) { 1494 if (init_vitesse(dev, np)) { 1495 netdev_info(dev, "%s: phy init failed\n", 1496 pci_name(np->pci_dev)); 1497 return PHY_ERROR; 1498 } 1499 } else if (np->phy_oui == PHY_OUI_REALTEK) { 1500 if (np->phy_model == PHY_MODEL_REALTEK_8211 && 1501 np->phy_rev == PHY_REV_REALTEK_8211B) { 1502 /* reset could have cleared these out, set them back */ 1503 if (init_realtek_8211b(dev, np)) { 1504 netdev_info(dev, "%s: phy init failed\n", 1505 pci_name(np->pci_dev)); 1506 return PHY_ERROR; 1507 } 1508 } else if (np->phy_model == PHY_MODEL_REALTEK_8201) { 1509 if (init_realtek_8201(dev, np) || 1510 init_realtek_8201_cross(dev, np)) { 1511 netdev_info(dev, "%s: phy init failed\n", 1512 pci_name(np->pci_dev)); 1513 return PHY_ERROR; 1514 } 1515 } 1516 } 1517 1518 /* some phys clear out pause advertisement on reset, set it back */ 1519 mii_rw(dev, np->phyaddr, MII_ADVERTISE, reg); 1520 1521 /* restart auto negotiation, power down phy */ 1522 mii_control = mii_rw(dev, np->phyaddr, MII_BMCR, MII_READ); 1523 mii_control |= (BMCR_ANRESTART | BMCR_ANENABLE); 1524 if (phy_power_down) 1525 mii_control |= BMCR_PDOWN; 1526 if (mii_rw(dev, np->phyaddr, MII_BMCR, mii_control)) 1527 return PHY_ERROR; 1528 1529 return 0; 1530 } 1531 1532 static void nv_start_rx(struct net_device *dev) 1533 { 1534 struct fe_priv *np = netdev_priv(dev); 1535 u8 __iomem *base = get_hwbase(dev); 1536 u32 rx_ctrl = readl(base + NvRegReceiverControl); 1537 1538 /* Already running? Stop it. */ 1539 if ((readl(base + NvRegReceiverControl) & NVREG_RCVCTL_START) && !np->mac_in_use) { 1540 rx_ctrl &= ~NVREG_RCVCTL_START; 1541 writel(rx_ctrl, base + NvRegReceiverControl); 1542 pci_push(base); 1543 } 1544 writel(np->linkspeed, base + NvRegLinkSpeed); 1545 pci_push(base); 1546 rx_ctrl |= NVREG_RCVCTL_START; 1547 if (np->mac_in_use) 1548 rx_ctrl &= ~NVREG_RCVCTL_RX_PATH_EN; 1549 writel(rx_ctrl, base + NvRegReceiverControl); 1550 pci_push(base); 1551 } 1552 1553 static void nv_stop_rx(struct net_device *dev) 1554 { 1555 struct fe_priv *np = netdev_priv(dev); 1556 u8 __iomem *base = get_hwbase(dev); 1557 u32 rx_ctrl = readl(base + NvRegReceiverControl); 1558 1559 if (!np->mac_in_use) 1560 rx_ctrl &= ~NVREG_RCVCTL_START; 1561 else 1562 rx_ctrl |= NVREG_RCVCTL_RX_PATH_EN; 1563 writel(rx_ctrl, base + NvRegReceiverControl); 1564 if (reg_delay(dev, NvRegReceiverStatus, NVREG_RCVSTAT_BUSY, 0, 1565 NV_RXSTOP_DELAY1, NV_RXSTOP_DELAY1MAX)) 1566 netdev_info(dev, "%s: ReceiverStatus remained busy\n", 1567 __func__); 1568 1569 udelay(NV_RXSTOP_DELAY2); 1570 if (!np->mac_in_use) 1571 writel(0, base + NvRegLinkSpeed); 1572 } 1573 1574 static void nv_start_tx(struct net_device *dev) 1575 { 1576 struct fe_priv *np = netdev_priv(dev); 1577 u8 __iomem *base = get_hwbase(dev); 1578 u32 tx_ctrl = readl(base + NvRegTransmitterControl); 1579 1580 tx_ctrl |= NVREG_XMITCTL_START; 1581 if (np->mac_in_use) 1582 tx_ctrl &= ~NVREG_XMITCTL_TX_PATH_EN; 1583 writel(tx_ctrl, base + NvRegTransmitterControl); 1584 pci_push(base); 1585 } 1586 1587 static void nv_stop_tx(struct net_device *dev) 1588 { 1589 struct fe_priv *np = netdev_priv(dev); 1590 u8 __iomem *base = get_hwbase(dev); 1591 u32 tx_ctrl = readl(base + NvRegTransmitterControl); 1592 1593 if (!np->mac_in_use) 1594 tx_ctrl &= ~NVREG_XMITCTL_START; 1595 else 1596 tx_ctrl |= NVREG_XMITCTL_TX_PATH_EN; 1597 writel(tx_ctrl, base + NvRegTransmitterControl); 1598 if (reg_delay(dev, NvRegTransmitterStatus, NVREG_XMITSTAT_BUSY, 0, 1599 NV_TXSTOP_DELAY1, NV_TXSTOP_DELAY1MAX)) 1600 netdev_info(dev, "%s: TransmitterStatus remained busy\n", 1601 __func__); 1602 1603 udelay(NV_TXSTOP_DELAY2); 1604 if (!np->mac_in_use) 1605 writel(readl(base + NvRegTransmitPoll) & NVREG_TRANSMITPOLL_MAC_ADDR_REV, 1606 base + NvRegTransmitPoll); 1607 } 1608 1609 static void nv_start_rxtx(struct net_device *dev) 1610 { 1611 nv_start_rx(dev); 1612 nv_start_tx(dev); 1613 } 1614 1615 static void nv_stop_rxtx(struct net_device *dev) 1616 { 1617 nv_stop_rx(dev); 1618 nv_stop_tx(dev); 1619 } 1620 1621 static void nv_txrx_reset(struct net_device *dev) 1622 { 1623 struct fe_priv *np = netdev_priv(dev); 1624 u8 __iomem *base = get_hwbase(dev); 1625 1626 writel(NVREG_TXRXCTL_BIT2 | NVREG_TXRXCTL_RESET | np->txrxctl_bits, base + NvRegTxRxControl); 1627 pci_push(base); 1628 udelay(NV_TXRX_RESET_DELAY); 1629 writel(NVREG_TXRXCTL_BIT2 | np->txrxctl_bits, base + NvRegTxRxControl); 1630 pci_push(base); 1631 } 1632 1633 static void nv_mac_reset(struct net_device *dev) 1634 { 1635 struct fe_priv *np = netdev_priv(dev); 1636 u8 __iomem *base = get_hwbase(dev); 1637 u32 temp1, temp2, temp3; 1638 1639 writel(NVREG_TXRXCTL_BIT2 | NVREG_TXRXCTL_RESET | np->txrxctl_bits, base + NvRegTxRxControl); 1640 pci_push(base); 1641 1642 /* save registers since they will be cleared on reset */ 1643 temp1 = readl(base + NvRegMacAddrA); 1644 temp2 = readl(base + NvRegMacAddrB); 1645 temp3 = readl(base + NvRegTransmitPoll); 1646 1647 writel(NVREG_MAC_RESET_ASSERT, base + NvRegMacReset); 1648 pci_push(base); 1649 udelay(NV_MAC_RESET_DELAY); 1650 writel(0, base + NvRegMacReset); 1651 pci_push(base); 1652 udelay(NV_MAC_RESET_DELAY); 1653 1654 /* restore saved registers */ 1655 writel(temp1, base + NvRegMacAddrA); 1656 writel(temp2, base + NvRegMacAddrB); 1657 writel(temp3, base + NvRegTransmitPoll); 1658 1659 writel(NVREG_TXRXCTL_BIT2 | np->txrxctl_bits, base + NvRegTxRxControl); 1660 pci_push(base); 1661 } 1662 1663 /* Caller must appropriately lock netdev_priv(dev)->hwstats_lock */ 1664 static void nv_update_stats(struct net_device *dev) 1665 { 1666 struct fe_priv *np = netdev_priv(dev); 1667 u8 __iomem *base = get_hwbase(dev); 1668 1669 lockdep_assert_held(&np->hwstats_lock); 1670 1671 /* query hardware */ 1672 np->estats.tx_bytes += readl(base + NvRegTxCnt); 1673 np->estats.tx_zero_rexmt += readl(base + NvRegTxZeroReXmt); 1674 np->estats.tx_one_rexmt += readl(base + NvRegTxOneReXmt); 1675 np->estats.tx_many_rexmt += readl(base + NvRegTxManyReXmt); 1676 np->estats.tx_late_collision += readl(base + NvRegTxLateCol); 1677 np->estats.tx_fifo_errors += readl(base + NvRegTxUnderflow); 1678 np->estats.tx_carrier_errors += readl(base + NvRegTxLossCarrier); 1679 np->estats.tx_excess_deferral += readl(base + NvRegTxExcessDef); 1680 np->estats.tx_retry_error += readl(base + NvRegTxRetryErr); 1681 np->estats.rx_frame_error += readl(base + NvRegRxFrameErr); 1682 np->estats.rx_extra_byte += readl(base + NvRegRxExtraByte); 1683 np->estats.rx_late_collision += readl(base + NvRegRxLateCol); 1684 np->estats.rx_runt += readl(base + NvRegRxRunt); 1685 np->estats.rx_frame_too_long += readl(base + NvRegRxFrameTooLong); 1686 np->estats.rx_over_errors += readl(base + NvRegRxOverflow); 1687 np->estats.rx_crc_errors += readl(base + NvRegRxFCSErr); 1688 np->estats.rx_frame_align_error += readl(base + NvRegRxFrameAlignErr); 1689 np->estats.rx_length_error += readl(base + NvRegRxLenErr); 1690 np->estats.rx_unicast += readl(base + NvRegRxUnicast); 1691 np->estats.rx_multicast += readl(base + NvRegRxMulticast); 1692 np->estats.rx_broadcast += readl(base + NvRegRxBroadcast); 1693 np->estats.rx_packets = 1694 np->estats.rx_unicast + 1695 np->estats.rx_multicast + 1696 np->estats.rx_broadcast; 1697 np->estats.rx_errors_total = 1698 np->estats.rx_crc_errors + 1699 np->estats.rx_over_errors + 1700 np->estats.rx_frame_error + 1701 (np->estats.rx_frame_align_error - np->estats.rx_extra_byte) + 1702 np->estats.rx_late_collision + 1703 np->estats.rx_runt + 1704 np->estats.rx_frame_too_long; 1705 np->estats.tx_errors_total = 1706 np->estats.tx_late_collision + 1707 np->estats.tx_fifo_errors + 1708 np->estats.tx_carrier_errors + 1709 np->estats.tx_excess_deferral + 1710 np->estats.tx_retry_error; 1711 1712 if (np->driver_data & DEV_HAS_STATISTICS_V2) { 1713 np->estats.tx_deferral += readl(base + NvRegTxDef); 1714 np->estats.tx_packets += readl(base + NvRegTxFrame); 1715 np->estats.rx_bytes += readl(base + NvRegRxCnt); 1716 np->estats.tx_pause += readl(base + NvRegTxPause); 1717 np->estats.rx_pause += readl(base + NvRegRxPause); 1718 np->estats.rx_drop_frame += readl(base + NvRegRxDropFrame); 1719 np->estats.rx_errors_total += np->estats.rx_drop_frame; 1720 } 1721 1722 if (np->driver_data & DEV_HAS_STATISTICS_V3) { 1723 np->estats.tx_unicast += readl(base + NvRegTxUnicast); 1724 np->estats.tx_multicast += readl(base + NvRegTxMulticast); 1725 np->estats.tx_broadcast += readl(base + NvRegTxBroadcast); 1726 } 1727 } 1728 1729 static void nv_get_stats(int cpu, struct fe_priv *np, 1730 struct rtnl_link_stats64 *storage) 1731 { 1732 struct nv_txrx_stats *src = per_cpu_ptr(np->txrx_stats, cpu); 1733 unsigned int syncp_start; 1734 u64 rx_packets, rx_bytes, rx_dropped, rx_missed_errors; 1735 u64 tx_packets, tx_bytes, tx_dropped; 1736 1737 do { 1738 syncp_start = u64_stats_fetch_begin_irq(&np->swstats_rx_syncp); 1739 rx_packets = src->stat_rx_packets; 1740 rx_bytes = src->stat_rx_bytes; 1741 rx_dropped = src->stat_rx_dropped; 1742 rx_missed_errors = src->stat_rx_missed_errors; 1743 } while (u64_stats_fetch_retry_irq(&np->swstats_rx_syncp, syncp_start)); 1744 1745 storage->rx_packets += rx_packets; 1746 storage->rx_bytes += rx_bytes; 1747 storage->rx_dropped += rx_dropped; 1748 storage->rx_missed_errors += rx_missed_errors; 1749 1750 do { 1751 syncp_start = u64_stats_fetch_begin_irq(&np->swstats_tx_syncp); 1752 tx_packets = src->stat_tx_packets; 1753 tx_bytes = src->stat_tx_bytes; 1754 tx_dropped = src->stat_tx_dropped; 1755 } while (u64_stats_fetch_retry_irq(&np->swstats_tx_syncp, syncp_start)); 1756 1757 storage->tx_packets += tx_packets; 1758 storage->tx_bytes += tx_bytes; 1759 storage->tx_dropped += tx_dropped; 1760 } 1761 1762 /* 1763 * nv_get_stats64: dev->ndo_get_stats64 function 1764 * Get latest stats value from the nic. 1765 * Called with read_lock(&dev_base_lock) held for read - 1766 * only synchronized against unregister_netdevice. 1767 */ 1768 static void 1769 nv_get_stats64(struct net_device *dev, struct rtnl_link_stats64 *storage) 1770 __acquires(&netdev_priv(dev)->hwstats_lock) 1771 __releases(&netdev_priv(dev)->hwstats_lock) 1772 { 1773 struct fe_priv *np = netdev_priv(dev); 1774 int cpu; 1775 1776 /* 1777 * Note: because HW stats are not always available and for 1778 * consistency reasons, the following ifconfig stats are 1779 * managed by software: rx_bytes, tx_bytes, rx_packets and 1780 * tx_packets. The related hardware stats reported by ethtool 1781 * should be equivalent to these ifconfig stats, with 4 1782 * additional bytes per packet (Ethernet FCS CRC), except for 1783 * tx_packets when TSO kicks in. 1784 */ 1785 1786 /* software stats */ 1787 for_each_online_cpu(cpu) 1788 nv_get_stats(cpu, np, storage); 1789 1790 /* If the nic supports hw counters then retrieve latest values */ 1791 if (np->driver_data & DEV_HAS_STATISTICS_V123) { 1792 spin_lock_bh(&np->hwstats_lock); 1793 1794 nv_update_stats(dev); 1795 1796 /* generic stats */ 1797 storage->rx_errors = np->estats.rx_errors_total; 1798 storage->tx_errors = np->estats.tx_errors_total; 1799 1800 /* meaningful only when NIC supports stats v3 */ 1801 storage->multicast = np->estats.rx_multicast; 1802 1803 /* detailed rx_errors */ 1804 storage->rx_length_errors = np->estats.rx_length_error; 1805 storage->rx_over_errors = np->estats.rx_over_errors; 1806 storage->rx_crc_errors = np->estats.rx_crc_errors; 1807 storage->rx_frame_errors = np->estats.rx_frame_align_error; 1808 storage->rx_fifo_errors = np->estats.rx_drop_frame; 1809 1810 /* detailed tx_errors */ 1811 storage->tx_carrier_errors = np->estats.tx_carrier_errors; 1812 storage->tx_fifo_errors = np->estats.tx_fifo_errors; 1813 1814 spin_unlock_bh(&np->hwstats_lock); 1815 } 1816 } 1817 1818 /* 1819 * nv_alloc_rx: fill rx ring entries. 1820 * Return 1 if the allocations for the skbs failed and the 1821 * rx engine is without Available descriptors 1822 */ 1823 static int nv_alloc_rx(struct net_device *dev) 1824 { 1825 struct fe_priv *np = netdev_priv(dev); 1826 struct ring_desc *less_rx; 1827 1828 less_rx = np->get_rx.orig; 1829 if (less_rx-- == np->rx_ring.orig) 1830 less_rx = np->last_rx.orig; 1831 1832 while (np->put_rx.orig != less_rx) { 1833 struct sk_buff *skb = netdev_alloc_skb(dev, np->rx_buf_sz + NV_RX_ALLOC_PAD); 1834 if (likely(skb)) { 1835 np->put_rx_ctx->skb = skb; 1836 np->put_rx_ctx->dma = dma_map_single(&np->pci_dev->dev, 1837 skb->data, 1838 skb_tailroom(skb), 1839 DMA_FROM_DEVICE); 1840 if (unlikely(dma_mapping_error(&np->pci_dev->dev, 1841 np->put_rx_ctx->dma))) { 1842 kfree_skb(skb); 1843 goto packet_dropped; 1844 } 1845 np->put_rx_ctx->dma_len = skb_tailroom(skb); 1846 np->put_rx.orig->buf = cpu_to_le32(np->put_rx_ctx->dma); 1847 wmb(); 1848 np->put_rx.orig->flaglen = cpu_to_le32(np->rx_buf_sz | NV_RX_AVAIL); 1849 if (unlikely(np->put_rx.orig++ == np->last_rx.orig)) 1850 np->put_rx.orig = np->rx_ring.orig; 1851 if (unlikely(np->put_rx_ctx++ == np->last_rx_ctx)) 1852 np->put_rx_ctx = np->rx_skb; 1853 } else { 1854 packet_dropped: 1855 u64_stats_update_begin(&np->swstats_rx_syncp); 1856 nv_txrx_stats_inc(stat_rx_dropped); 1857 u64_stats_update_end(&np->swstats_rx_syncp); 1858 return 1; 1859 } 1860 } 1861 return 0; 1862 } 1863 1864 static int nv_alloc_rx_optimized(struct net_device *dev) 1865 { 1866 struct fe_priv *np = netdev_priv(dev); 1867 struct ring_desc_ex *less_rx; 1868 1869 less_rx = np->get_rx.ex; 1870 if (less_rx-- == np->rx_ring.ex) 1871 less_rx = np->last_rx.ex; 1872 1873 while (np->put_rx.ex != less_rx) { 1874 struct sk_buff *skb = netdev_alloc_skb(dev, np->rx_buf_sz + NV_RX_ALLOC_PAD); 1875 if (likely(skb)) { 1876 np->put_rx_ctx->skb = skb; 1877 np->put_rx_ctx->dma = dma_map_single(&np->pci_dev->dev, 1878 skb->data, 1879 skb_tailroom(skb), 1880 DMA_FROM_DEVICE); 1881 if (unlikely(dma_mapping_error(&np->pci_dev->dev, 1882 np->put_rx_ctx->dma))) { 1883 kfree_skb(skb); 1884 goto packet_dropped; 1885 } 1886 np->put_rx_ctx->dma_len = skb_tailroom(skb); 1887 np->put_rx.ex->bufhigh = cpu_to_le32(dma_high(np->put_rx_ctx->dma)); 1888 np->put_rx.ex->buflow = cpu_to_le32(dma_low(np->put_rx_ctx->dma)); 1889 wmb(); 1890 np->put_rx.ex->flaglen = cpu_to_le32(np->rx_buf_sz | NV_RX2_AVAIL); 1891 if (unlikely(np->put_rx.ex++ == np->last_rx.ex)) 1892 np->put_rx.ex = np->rx_ring.ex; 1893 if (unlikely(np->put_rx_ctx++ == np->last_rx_ctx)) 1894 np->put_rx_ctx = np->rx_skb; 1895 } else { 1896 packet_dropped: 1897 u64_stats_update_begin(&np->swstats_rx_syncp); 1898 nv_txrx_stats_inc(stat_rx_dropped); 1899 u64_stats_update_end(&np->swstats_rx_syncp); 1900 return 1; 1901 } 1902 } 1903 return 0; 1904 } 1905 1906 /* If rx bufs are exhausted called after 50ms to attempt to refresh */ 1907 static void nv_do_rx_refill(struct timer_list *t) 1908 { 1909 struct fe_priv *np = from_timer(np, t, oom_kick); 1910 1911 /* Just reschedule NAPI rx processing */ 1912 napi_schedule(&np->napi); 1913 } 1914 1915 static void nv_init_rx(struct net_device *dev) 1916 { 1917 struct fe_priv *np = netdev_priv(dev); 1918 int i; 1919 1920 np->get_rx = np->rx_ring; 1921 np->put_rx = np->rx_ring; 1922 1923 if (!nv_optimized(np)) 1924 np->last_rx.orig = &np->rx_ring.orig[np->rx_ring_size-1]; 1925 else 1926 np->last_rx.ex = &np->rx_ring.ex[np->rx_ring_size-1]; 1927 np->get_rx_ctx = np->rx_skb; 1928 np->put_rx_ctx = np->rx_skb; 1929 np->last_rx_ctx = &np->rx_skb[np->rx_ring_size-1]; 1930 1931 for (i = 0; i < np->rx_ring_size; i++) { 1932 if (!nv_optimized(np)) { 1933 np->rx_ring.orig[i].flaglen = 0; 1934 np->rx_ring.orig[i].buf = 0; 1935 } else { 1936 np->rx_ring.ex[i].flaglen = 0; 1937 np->rx_ring.ex[i].txvlan = 0; 1938 np->rx_ring.ex[i].bufhigh = 0; 1939 np->rx_ring.ex[i].buflow = 0; 1940 } 1941 np->rx_skb[i].skb = NULL; 1942 np->rx_skb[i].dma = 0; 1943 } 1944 } 1945 1946 static void nv_init_tx(struct net_device *dev) 1947 { 1948 struct fe_priv *np = netdev_priv(dev); 1949 int i; 1950 1951 np->get_tx = np->tx_ring; 1952 np->put_tx = np->tx_ring; 1953 1954 if (!nv_optimized(np)) 1955 np->last_tx.orig = &np->tx_ring.orig[np->tx_ring_size-1]; 1956 else 1957 np->last_tx.ex = &np->tx_ring.ex[np->tx_ring_size-1]; 1958 np->get_tx_ctx = np->tx_skb; 1959 np->put_tx_ctx = np->tx_skb; 1960 np->last_tx_ctx = &np->tx_skb[np->tx_ring_size-1]; 1961 netdev_reset_queue(np->dev); 1962 np->tx_pkts_in_progress = 0; 1963 np->tx_change_owner = NULL; 1964 np->tx_end_flip = NULL; 1965 np->tx_stop = 0; 1966 1967 for (i = 0; i < np->tx_ring_size; i++) { 1968 if (!nv_optimized(np)) { 1969 np->tx_ring.orig[i].flaglen = 0; 1970 np->tx_ring.orig[i].buf = 0; 1971 } else { 1972 np->tx_ring.ex[i].flaglen = 0; 1973 np->tx_ring.ex[i].txvlan = 0; 1974 np->tx_ring.ex[i].bufhigh = 0; 1975 np->tx_ring.ex[i].buflow = 0; 1976 } 1977 np->tx_skb[i].skb = NULL; 1978 np->tx_skb[i].dma = 0; 1979 np->tx_skb[i].dma_len = 0; 1980 np->tx_skb[i].dma_single = 0; 1981 np->tx_skb[i].first_tx_desc = NULL; 1982 np->tx_skb[i].next_tx_ctx = NULL; 1983 } 1984 } 1985 1986 static int nv_init_ring(struct net_device *dev) 1987 { 1988 struct fe_priv *np = netdev_priv(dev); 1989 1990 nv_init_tx(dev); 1991 nv_init_rx(dev); 1992 1993 if (!nv_optimized(np)) 1994 return nv_alloc_rx(dev); 1995 else 1996 return nv_alloc_rx_optimized(dev); 1997 } 1998 1999 static void nv_unmap_txskb(struct fe_priv *np, struct nv_skb_map *tx_skb) 2000 { 2001 if (tx_skb->dma) { 2002 if (tx_skb->dma_single) 2003 dma_unmap_single(&np->pci_dev->dev, tx_skb->dma, 2004 tx_skb->dma_len, 2005 DMA_TO_DEVICE); 2006 else 2007 dma_unmap_page(&np->pci_dev->dev, tx_skb->dma, 2008 tx_skb->dma_len, 2009 DMA_TO_DEVICE); 2010 tx_skb->dma = 0; 2011 } 2012 } 2013 2014 static int nv_release_txskb(struct fe_priv *np, struct nv_skb_map *tx_skb) 2015 { 2016 nv_unmap_txskb(np, tx_skb); 2017 if (tx_skb->skb) { 2018 dev_kfree_skb_any(tx_skb->skb); 2019 tx_skb->skb = NULL; 2020 return 1; 2021 } 2022 return 0; 2023 } 2024 2025 static void nv_drain_tx(struct net_device *dev) 2026 { 2027 struct fe_priv *np = netdev_priv(dev); 2028 unsigned int i; 2029 2030 for (i = 0; i < np->tx_ring_size; i++) { 2031 if (!nv_optimized(np)) { 2032 np->tx_ring.orig[i].flaglen = 0; 2033 np->tx_ring.orig[i].buf = 0; 2034 } else { 2035 np->tx_ring.ex[i].flaglen = 0; 2036 np->tx_ring.ex[i].txvlan = 0; 2037 np->tx_ring.ex[i].bufhigh = 0; 2038 np->tx_ring.ex[i].buflow = 0; 2039 } 2040 if (nv_release_txskb(np, &np->tx_skb[i])) { 2041 u64_stats_update_begin(&np->swstats_tx_syncp); 2042 nv_txrx_stats_inc(stat_tx_dropped); 2043 u64_stats_update_end(&np->swstats_tx_syncp); 2044 } 2045 np->tx_skb[i].dma = 0; 2046 np->tx_skb[i].dma_len = 0; 2047 np->tx_skb[i].dma_single = 0; 2048 np->tx_skb[i].first_tx_desc = NULL; 2049 np->tx_skb[i].next_tx_ctx = NULL; 2050 } 2051 np->tx_pkts_in_progress = 0; 2052 np->tx_change_owner = NULL; 2053 np->tx_end_flip = NULL; 2054 } 2055 2056 static void nv_drain_rx(struct net_device *dev) 2057 { 2058 struct fe_priv *np = netdev_priv(dev); 2059 int i; 2060 2061 for (i = 0; i < np->rx_ring_size; i++) { 2062 if (!nv_optimized(np)) { 2063 np->rx_ring.orig[i].flaglen = 0; 2064 np->rx_ring.orig[i].buf = 0; 2065 } else { 2066 np->rx_ring.ex[i].flaglen = 0; 2067 np->rx_ring.ex[i].txvlan = 0; 2068 np->rx_ring.ex[i].bufhigh = 0; 2069 np->rx_ring.ex[i].buflow = 0; 2070 } 2071 wmb(); 2072 if (np->rx_skb[i].skb) { 2073 dma_unmap_single(&np->pci_dev->dev, np->rx_skb[i].dma, 2074 (skb_end_pointer(np->rx_skb[i].skb) - 2075 np->rx_skb[i].skb->data), 2076 DMA_FROM_DEVICE); 2077 dev_kfree_skb(np->rx_skb[i].skb); 2078 np->rx_skb[i].skb = NULL; 2079 } 2080 } 2081 } 2082 2083 static void nv_drain_rxtx(struct net_device *dev) 2084 { 2085 nv_drain_tx(dev); 2086 nv_drain_rx(dev); 2087 } 2088 2089 static inline u32 nv_get_empty_tx_slots(struct fe_priv *np) 2090 { 2091 return (u32)(np->tx_ring_size - ((np->tx_ring_size + (np->put_tx_ctx - np->get_tx_ctx)) % np->tx_ring_size)); 2092 } 2093 2094 static void nv_legacybackoff_reseed(struct net_device *dev) 2095 { 2096 u8 __iomem *base = get_hwbase(dev); 2097 u32 reg; 2098 u32 low; 2099 int tx_status = 0; 2100 2101 reg = readl(base + NvRegSlotTime) & ~NVREG_SLOTTIME_MASK; 2102 get_random_bytes(&low, sizeof(low)); 2103 reg |= low & NVREG_SLOTTIME_MASK; 2104 2105 /* Need to stop tx before change takes effect. 2106 * Caller has already gained np->lock. 2107 */ 2108 tx_status = readl(base + NvRegTransmitterControl) & NVREG_XMITCTL_START; 2109 if (tx_status) 2110 nv_stop_tx(dev); 2111 nv_stop_rx(dev); 2112 writel(reg, base + NvRegSlotTime); 2113 if (tx_status) 2114 nv_start_tx(dev); 2115 nv_start_rx(dev); 2116 } 2117 2118 /* Gear Backoff Seeds */ 2119 #define BACKOFF_SEEDSET_ROWS 8 2120 #define BACKOFF_SEEDSET_LFSRS 15 2121 2122 /* Known Good seed sets */ 2123 static const u32 main_seedset[BACKOFF_SEEDSET_ROWS][BACKOFF_SEEDSET_LFSRS] = { 2124 {145, 155, 165, 175, 185, 196, 235, 245, 255, 265, 275, 285, 660, 690, 874}, 2125 {245, 255, 265, 575, 385, 298, 335, 345, 355, 366, 375, 385, 761, 790, 974}, 2126 {145, 155, 165, 175, 185, 196, 235, 245, 255, 265, 275, 285, 660, 690, 874}, 2127 {245, 255, 265, 575, 385, 298, 335, 345, 355, 366, 375, 386, 761, 790, 974}, 2128 {266, 265, 276, 585, 397, 208, 345, 355, 365, 376, 385, 396, 771, 700, 984}, 2129 {266, 265, 276, 586, 397, 208, 346, 355, 365, 376, 285, 396, 771, 700, 984}, 2130 {366, 365, 376, 686, 497, 308, 447, 455, 466, 476, 485, 496, 871, 800, 84}, 2131 {466, 465, 476, 786, 597, 408, 547, 555, 566, 576, 585, 597, 971, 900, 184} }; 2132 2133 static const u32 gear_seedset[BACKOFF_SEEDSET_ROWS][BACKOFF_SEEDSET_LFSRS] = { 2134 {251, 262, 273, 324, 319, 508, 375, 364, 341, 371, 398, 193, 375, 30, 295}, 2135 {351, 375, 373, 469, 551, 639, 477, 464, 441, 472, 498, 293, 476, 130, 395}, 2136 {351, 375, 373, 469, 551, 639, 477, 464, 441, 472, 498, 293, 476, 130, 397}, 2137 {251, 262, 273, 324, 319, 508, 375, 364, 341, 371, 398, 193, 375, 30, 295}, 2138 {251, 262, 273, 324, 319, 508, 375, 364, 341, 371, 398, 193, 375, 30, 295}, 2139 {351, 375, 373, 469, 551, 639, 477, 464, 441, 472, 498, 293, 476, 130, 395}, 2140 {351, 375, 373, 469, 551, 639, 477, 464, 441, 472, 498, 293, 476, 130, 395}, 2141 {351, 375, 373, 469, 551, 639, 477, 464, 441, 472, 498, 293, 476, 130, 395} }; 2142 2143 static void nv_gear_backoff_reseed(struct net_device *dev) 2144 { 2145 u8 __iomem *base = get_hwbase(dev); 2146 u32 miniseed1, miniseed2, miniseed2_reversed, miniseed3, miniseed3_reversed; 2147 u32 temp, seedset, combinedSeed; 2148 int i; 2149 2150 /* Setup seed for free running LFSR */ 2151 /* We are going to read the time stamp counter 3 times 2152 and swizzle bits around to increase randomness */ 2153 get_random_bytes(&miniseed1, sizeof(miniseed1)); 2154 miniseed1 &= 0x0fff; 2155 if (miniseed1 == 0) 2156 miniseed1 = 0xabc; 2157 2158 get_random_bytes(&miniseed2, sizeof(miniseed2)); 2159 miniseed2 &= 0x0fff; 2160 if (miniseed2 == 0) 2161 miniseed2 = 0xabc; 2162 miniseed2_reversed = 2163 ((miniseed2 & 0xF00) >> 8) | 2164 (miniseed2 & 0x0F0) | 2165 ((miniseed2 & 0x00F) << 8); 2166 2167 get_random_bytes(&miniseed3, sizeof(miniseed3)); 2168 miniseed3 &= 0x0fff; 2169 if (miniseed3 == 0) 2170 miniseed3 = 0xabc; 2171 miniseed3_reversed = 2172 ((miniseed3 & 0xF00) >> 8) | 2173 (miniseed3 & 0x0F0) | 2174 ((miniseed3 & 0x00F) << 8); 2175 2176 combinedSeed = ((miniseed1 ^ miniseed2_reversed) << 12) | 2177 (miniseed2 ^ miniseed3_reversed); 2178 2179 /* Seeds can not be zero */ 2180 if ((combinedSeed & NVREG_BKOFFCTRL_SEED_MASK) == 0) 2181 combinedSeed |= 0x08; 2182 if ((combinedSeed & (NVREG_BKOFFCTRL_SEED_MASK << NVREG_BKOFFCTRL_GEAR)) == 0) 2183 combinedSeed |= 0x8000; 2184 2185 /* No need to disable tx here */ 2186 temp = NVREG_BKOFFCTRL_DEFAULT | (0 << NVREG_BKOFFCTRL_SELECT); 2187 temp |= combinedSeed & NVREG_BKOFFCTRL_SEED_MASK; 2188 temp |= combinedSeed >> NVREG_BKOFFCTRL_GEAR; 2189 writel(temp, base + NvRegBackOffControl); 2190 2191 /* Setup seeds for all gear LFSRs. */ 2192 get_random_bytes(&seedset, sizeof(seedset)); 2193 seedset = seedset % BACKOFF_SEEDSET_ROWS; 2194 for (i = 1; i <= BACKOFF_SEEDSET_LFSRS; i++) { 2195 temp = NVREG_BKOFFCTRL_DEFAULT | (i << NVREG_BKOFFCTRL_SELECT); 2196 temp |= main_seedset[seedset][i-1] & 0x3ff; 2197 temp |= ((gear_seedset[seedset][i-1] & 0x3ff) << NVREG_BKOFFCTRL_GEAR); 2198 writel(temp, base + NvRegBackOffControl); 2199 } 2200 } 2201 2202 /* 2203 * nv_start_xmit: dev->hard_start_xmit function 2204 * Called with netif_tx_lock held. 2205 */ 2206 static netdev_tx_t nv_start_xmit(struct sk_buff *skb, struct net_device *dev) 2207 { 2208 struct fe_priv *np = netdev_priv(dev); 2209 u32 tx_flags = 0; 2210 u32 tx_flags_extra = (np->desc_ver == DESC_VER_1 ? NV_TX_LASTPACKET : NV_TX2_LASTPACKET); 2211 unsigned int fragments = skb_shinfo(skb)->nr_frags; 2212 unsigned int i; 2213 u32 offset = 0; 2214 u32 bcnt; 2215 u32 size = skb_headlen(skb); 2216 u32 entries = (size >> NV_TX2_TSO_MAX_SHIFT) + ((size & (NV_TX2_TSO_MAX_SIZE-1)) ? 1 : 0); 2217 u32 empty_slots; 2218 struct ring_desc *put_tx; 2219 struct ring_desc *start_tx; 2220 struct ring_desc *prev_tx; 2221 struct nv_skb_map *prev_tx_ctx; 2222 struct nv_skb_map *tmp_tx_ctx = NULL, *start_tx_ctx = NULL; 2223 unsigned long flags; 2224 netdev_tx_t ret = NETDEV_TX_OK; 2225 2226 /* add fragments to entries count */ 2227 for (i = 0; i < fragments; i++) { 2228 u32 frag_size = skb_frag_size(&skb_shinfo(skb)->frags[i]); 2229 2230 entries += (frag_size >> NV_TX2_TSO_MAX_SHIFT) + 2231 ((frag_size & (NV_TX2_TSO_MAX_SIZE-1)) ? 1 : 0); 2232 } 2233 2234 spin_lock_irqsave(&np->lock, flags); 2235 empty_slots = nv_get_empty_tx_slots(np); 2236 if (unlikely(empty_slots <= entries)) { 2237 netif_stop_queue(dev); 2238 np->tx_stop = 1; 2239 spin_unlock_irqrestore(&np->lock, flags); 2240 2241 /* When normal packets and/or xmit_more packets fill up 2242 * tx_desc, it is necessary to trigger NIC tx reg. 2243 */ 2244 ret = NETDEV_TX_BUSY; 2245 goto txkick; 2246 } 2247 spin_unlock_irqrestore(&np->lock, flags); 2248 2249 start_tx = put_tx = np->put_tx.orig; 2250 2251 /* setup the header buffer */ 2252 do { 2253 bcnt = (size > NV_TX2_TSO_MAX_SIZE) ? NV_TX2_TSO_MAX_SIZE : size; 2254 np->put_tx_ctx->dma = dma_map_single(&np->pci_dev->dev, 2255 skb->data + offset, bcnt, 2256 DMA_TO_DEVICE); 2257 if (unlikely(dma_mapping_error(&np->pci_dev->dev, 2258 np->put_tx_ctx->dma))) { 2259 /* on DMA mapping error - drop the packet */ 2260 dev_kfree_skb_any(skb); 2261 u64_stats_update_begin(&np->swstats_tx_syncp); 2262 nv_txrx_stats_inc(stat_tx_dropped); 2263 u64_stats_update_end(&np->swstats_tx_syncp); 2264 2265 ret = NETDEV_TX_OK; 2266 2267 goto dma_error; 2268 } 2269 np->put_tx_ctx->dma_len = bcnt; 2270 np->put_tx_ctx->dma_single = 1; 2271 put_tx->buf = cpu_to_le32(np->put_tx_ctx->dma); 2272 put_tx->flaglen = cpu_to_le32((bcnt-1) | tx_flags); 2273 2274 tx_flags = np->tx_flags; 2275 offset += bcnt; 2276 size -= bcnt; 2277 if (unlikely(put_tx++ == np->last_tx.orig)) 2278 put_tx = np->tx_ring.orig; 2279 if (unlikely(np->put_tx_ctx++ == np->last_tx_ctx)) 2280 np->put_tx_ctx = np->tx_skb; 2281 } while (size); 2282 2283 /* setup the fragments */ 2284 for (i = 0; i < fragments; i++) { 2285 const skb_frag_t *frag = &skb_shinfo(skb)->frags[i]; 2286 u32 frag_size = skb_frag_size(frag); 2287 offset = 0; 2288 2289 do { 2290 if (!start_tx_ctx) 2291 start_tx_ctx = tmp_tx_ctx = np->put_tx_ctx; 2292 2293 bcnt = (frag_size > NV_TX2_TSO_MAX_SIZE) ? NV_TX2_TSO_MAX_SIZE : frag_size; 2294 np->put_tx_ctx->dma = skb_frag_dma_map( 2295 &np->pci_dev->dev, 2296 frag, offset, 2297 bcnt, 2298 DMA_TO_DEVICE); 2299 if (unlikely(dma_mapping_error(&np->pci_dev->dev, 2300 np->put_tx_ctx->dma))) { 2301 2302 /* Unwind the mapped fragments */ 2303 do { 2304 nv_unmap_txskb(np, start_tx_ctx); 2305 if (unlikely(tmp_tx_ctx++ == np->last_tx_ctx)) 2306 tmp_tx_ctx = np->tx_skb; 2307 } while (tmp_tx_ctx != np->put_tx_ctx); 2308 dev_kfree_skb_any(skb); 2309 np->put_tx_ctx = start_tx_ctx; 2310 u64_stats_update_begin(&np->swstats_tx_syncp); 2311 nv_txrx_stats_inc(stat_tx_dropped); 2312 u64_stats_update_end(&np->swstats_tx_syncp); 2313 2314 ret = NETDEV_TX_OK; 2315 2316 goto dma_error; 2317 } 2318 2319 np->put_tx_ctx->dma_len = bcnt; 2320 np->put_tx_ctx->dma_single = 0; 2321 put_tx->buf = cpu_to_le32(np->put_tx_ctx->dma); 2322 put_tx->flaglen = cpu_to_le32((bcnt-1) | tx_flags); 2323 2324 offset += bcnt; 2325 frag_size -= bcnt; 2326 if (unlikely(put_tx++ == np->last_tx.orig)) 2327 put_tx = np->tx_ring.orig; 2328 if (unlikely(np->put_tx_ctx++ == np->last_tx_ctx)) 2329 np->put_tx_ctx = np->tx_skb; 2330 } while (frag_size); 2331 } 2332 2333 if (unlikely(put_tx == np->tx_ring.orig)) 2334 prev_tx = np->last_tx.orig; 2335 else 2336 prev_tx = put_tx - 1; 2337 2338 if (unlikely(np->put_tx_ctx == np->tx_skb)) 2339 prev_tx_ctx = np->last_tx_ctx; 2340 else 2341 prev_tx_ctx = np->put_tx_ctx - 1; 2342 2343 /* set last fragment flag */ 2344 prev_tx->flaglen |= cpu_to_le32(tx_flags_extra); 2345 2346 /* save skb in this slot's context area */ 2347 prev_tx_ctx->skb = skb; 2348 2349 if (skb_is_gso(skb)) 2350 tx_flags_extra = NV_TX2_TSO | (skb_shinfo(skb)->gso_size << NV_TX2_TSO_SHIFT); 2351 else 2352 tx_flags_extra = skb->ip_summed == CHECKSUM_PARTIAL ? 2353 NV_TX2_CHECKSUM_L3 | NV_TX2_CHECKSUM_L4 : 0; 2354 2355 spin_lock_irqsave(&np->lock, flags); 2356 2357 /* set tx flags */ 2358 start_tx->flaglen |= cpu_to_le32(tx_flags | tx_flags_extra); 2359 2360 netdev_sent_queue(np->dev, skb->len); 2361 2362 skb_tx_timestamp(skb); 2363 2364 np->put_tx.orig = put_tx; 2365 2366 spin_unlock_irqrestore(&np->lock, flags); 2367 2368 txkick: 2369 if (netif_queue_stopped(dev) || !netdev_xmit_more()) { 2370 u32 txrxctl_kick; 2371 dma_error: 2372 txrxctl_kick = NVREG_TXRXCTL_KICK | np->txrxctl_bits; 2373 writel(txrxctl_kick, get_hwbase(dev) + NvRegTxRxControl); 2374 } 2375 2376 return ret; 2377 } 2378 2379 static netdev_tx_t nv_start_xmit_optimized(struct sk_buff *skb, 2380 struct net_device *dev) 2381 { 2382 struct fe_priv *np = netdev_priv(dev); 2383 u32 tx_flags = 0; 2384 u32 tx_flags_extra; 2385 unsigned int fragments = skb_shinfo(skb)->nr_frags; 2386 unsigned int i; 2387 u32 offset = 0; 2388 u32 bcnt; 2389 u32 size = skb_headlen(skb); 2390 u32 entries = (size >> NV_TX2_TSO_MAX_SHIFT) + ((size & (NV_TX2_TSO_MAX_SIZE-1)) ? 1 : 0); 2391 u32 empty_slots; 2392 struct ring_desc_ex *put_tx; 2393 struct ring_desc_ex *start_tx; 2394 struct ring_desc_ex *prev_tx; 2395 struct nv_skb_map *prev_tx_ctx; 2396 struct nv_skb_map *start_tx_ctx = NULL; 2397 struct nv_skb_map *tmp_tx_ctx = NULL; 2398 unsigned long flags; 2399 netdev_tx_t ret = NETDEV_TX_OK; 2400 2401 /* add fragments to entries count */ 2402 for (i = 0; i < fragments; i++) { 2403 u32 frag_size = skb_frag_size(&skb_shinfo(skb)->frags[i]); 2404 2405 entries += (frag_size >> NV_TX2_TSO_MAX_SHIFT) + 2406 ((frag_size & (NV_TX2_TSO_MAX_SIZE-1)) ? 1 : 0); 2407 } 2408 2409 spin_lock_irqsave(&np->lock, flags); 2410 empty_slots = nv_get_empty_tx_slots(np); 2411 if (unlikely(empty_slots <= entries)) { 2412 netif_stop_queue(dev); 2413 np->tx_stop = 1; 2414 spin_unlock_irqrestore(&np->lock, flags); 2415 2416 /* When normal packets and/or xmit_more packets fill up 2417 * tx_desc, it is necessary to trigger NIC tx reg. 2418 */ 2419 ret = NETDEV_TX_BUSY; 2420 2421 goto txkick; 2422 } 2423 spin_unlock_irqrestore(&np->lock, flags); 2424 2425 start_tx = put_tx = np->put_tx.ex; 2426 start_tx_ctx = np->put_tx_ctx; 2427 2428 /* setup the header buffer */ 2429 do { 2430 bcnt = (size > NV_TX2_TSO_MAX_SIZE) ? NV_TX2_TSO_MAX_SIZE : size; 2431 np->put_tx_ctx->dma = dma_map_single(&np->pci_dev->dev, 2432 skb->data + offset, bcnt, 2433 DMA_TO_DEVICE); 2434 if (unlikely(dma_mapping_error(&np->pci_dev->dev, 2435 np->put_tx_ctx->dma))) { 2436 /* on DMA mapping error - drop the packet */ 2437 dev_kfree_skb_any(skb); 2438 u64_stats_update_begin(&np->swstats_tx_syncp); 2439 nv_txrx_stats_inc(stat_tx_dropped); 2440 u64_stats_update_end(&np->swstats_tx_syncp); 2441 2442 ret = NETDEV_TX_OK; 2443 2444 goto dma_error; 2445 } 2446 np->put_tx_ctx->dma_len = bcnt; 2447 np->put_tx_ctx->dma_single = 1; 2448 put_tx->bufhigh = cpu_to_le32(dma_high(np->put_tx_ctx->dma)); 2449 put_tx->buflow = cpu_to_le32(dma_low(np->put_tx_ctx->dma)); 2450 put_tx->flaglen = cpu_to_le32((bcnt-1) | tx_flags); 2451 2452 tx_flags = NV_TX2_VALID; 2453 offset += bcnt; 2454 size -= bcnt; 2455 if (unlikely(put_tx++ == np->last_tx.ex)) 2456 put_tx = np->tx_ring.ex; 2457 if (unlikely(np->put_tx_ctx++ == np->last_tx_ctx)) 2458 np->put_tx_ctx = np->tx_skb; 2459 } while (size); 2460 2461 /* setup the fragments */ 2462 for (i = 0; i < fragments; i++) { 2463 skb_frag_t *frag = &skb_shinfo(skb)->frags[i]; 2464 u32 frag_size = skb_frag_size(frag); 2465 offset = 0; 2466 2467 do { 2468 bcnt = (frag_size > NV_TX2_TSO_MAX_SIZE) ? NV_TX2_TSO_MAX_SIZE : frag_size; 2469 if (!start_tx_ctx) 2470 start_tx_ctx = tmp_tx_ctx = np->put_tx_ctx; 2471 np->put_tx_ctx->dma = skb_frag_dma_map( 2472 &np->pci_dev->dev, 2473 frag, offset, 2474 bcnt, 2475 DMA_TO_DEVICE); 2476 2477 if (unlikely(dma_mapping_error(&np->pci_dev->dev, 2478 np->put_tx_ctx->dma))) { 2479 2480 /* Unwind the mapped fragments */ 2481 do { 2482 nv_unmap_txskb(np, start_tx_ctx); 2483 if (unlikely(tmp_tx_ctx++ == np->last_tx_ctx)) 2484 tmp_tx_ctx = np->tx_skb; 2485 } while (tmp_tx_ctx != np->put_tx_ctx); 2486 dev_kfree_skb_any(skb); 2487 np->put_tx_ctx = start_tx_ctx; 2488 u64_stats_update_begin(&np->swstats_tx_syncp); 2489 nv_txrx_stats_inc(stat_tx_dropped); 2490 u64_stats_update_end(&np->swstats_tx_syncp); 2491 2492 ret = NETDEV_TX_OK; 2493 2494 goto dma_error; 2495 } 2496 np->put_tx_ctx->dma_len = bcnt; 2497 np->put_tx_ctx->dma_single = 0; 2498 put_tx->bufhigh = cpu_to_le32(dma_high(np->put_tx_ctx->dma)); 2499 put_tx->buflow = cpu_to_le32(dma_low(np->put_tx_ctx->dma)); 2500 put_tx->flaglen = cpu_to_le32((bcnt-1) | tx_flags); 2501 2502 offset += bcnt; 2503 frag_size -= bcnt; 2504 if (unlikely(put_tx++ == np->last_tx.ex)) 2505 put_tx = np->tx_ring.ex; 2506 if (unlikely(np->put_tx_ctx++ == np->last_tx_ctx)) 2507 np->put_tx_ctx = np->tx_skb; 2508 } while (frag_size); 2509 } 2510 2511 if (unlikely(put_tx == np->tx_ring.ex)) 2512 prev_tx = np->last_tx.ex; 2513 else 2514 prev_tx = put_tx - 1; 2515 2516 if (unlikely(np->put_tx_ctx == np->tx_skb)) 2517 prev_tx_ctx = np->last_tx_ctx; 2518 else 2519 prev_tx_ctx = np->put_tx_ctx - 1; 2520 2521 /* set last fragment flag */ 2522 prev_tx->flaglen |= cpu_to_le32(NV_TX2_LASTPACKET); 2523 2524 /* save skb in this slot's context area */ 2525 prev_tx_ctx->skb = skb; 2526 2527 if (skb_is_gso(skb)) 2528 tx_flags_extra = NV_TX2_TSO | (skb_shinfo(skb)->gso_size << NV_TX2_TSO_SHIFT); 2529 else 2530 tx_flags_extra = skb->ip_summed == CHECKSUM_PARTIAL ? 2531 NV_TX2_CHECKSUM_L3 | NV_TX2_CHECKSUM_L4 : 0; 2532 2533 /* vlan tag */ 2534 if (skb_vlan_tag_present(skb)) 2535 start_tx->txvlan = cpu_to_le32(NV_TX3_VLAN_TAG_PRESENT | 2536 skb_vlan_tag_get(skb)); 2537 else 2538 start_tx->txvlan = 0; 2539 2540 spin_lock_irqsave(&np->lock, flags); 2541 2542 if (np->tx_limit) { 2543 /* Limit the number of outstanding tx. Setup all fragments, but 2544 * do not set the VALID bit on the first descriptor. Save a pointer 2545 * to that descriptor and also for next skb_map element. 2546 */ 2547 2548 if (np->tx_pkts_in_progress == NV_TX_LIMIT_COUNT) { 2549 if (!np->tx_change_owner) 2550 np->tx_change_owner = start_tx_ctx; 2551 2552 /* remove VALID bit */ 2553 tx_flags &= ~NV_TX2_VALID; 2554 start_tx_ctx->first_tx_desc = start_tx; 2555 start_tx_ctx->next_tx_ctx = np->put_tx_ctx; 2556 np->tx_end_flip = np->put_tx_ctx; 2557 } else { 2558 np->tx_pkts_in_progress++; 2559 } 2560 } 2561 2562 /* set tx flags */ 2563 start_tx->flaglen |= cpu_to_le32(tx_flags | tx_flags_extra); 2564 2565 netdev_sent_queue(np->dev, skb->len); 2566 2567 skb_tx_timestamp(skb); 2568 2569 np->put_tx.ex = put_tx; 2570 2571 spin_unlock_irqrestore(&np->lock, flags); 2572 2573 txkick: 2574 if (netif_queue_stopped(dev) || !netdev_xmit_more()) { 2575 u32 txrxctl_kick; 2576 dma_error: 2577 txrxctl_kick = NVREG_TXRXCTL_KICK | np->txrxctl_bits; 2578 writel(txrxctl_kick, get_hwbase(dev) + NvRegTxRxControl); 2579 } 2580 2581 return ret; 2582 } 2583 2584 static inline void nv_tx_flip_ownership(struct net_device *dev) 2585 { 2586 struct fe_priv *np = netdev_priv(dev); 2587 2588 np->tx_pkts_in_progress--; 2589 if (np->tx_change_owner) { 2590 np->tx_change_owner->first_tx_desc->flaglen |= 2591 cpu_to_le32(NV_TX2_VALID); 2592 np->tx_pkts_in_progress++; 2593 2594 np->tx_change_owner = np->tx_change_owner->next_tx_ctx; 2595 if (np->tx_change_owner == np->tx_end_flip) 2596 np->tx_change_owner = NULL; 2597 2598 writel(NVREG_TXRXCTL_KICK|np->txrxctl_bits, get_hwbase(dev) + NvRegTxRxControl); 2599 } 2600 } 2601 2602 /* 2603 * nv_tx_done: check for completed packets, release the skbs. 2604 * 2605 * Caller must own np->lock. 2606 */ 2607 static int nv_tx_done(struct net_device *dev, int limit) 2608 { 2609 struct fe_priv *np = netdev_priv(dev); 2610 u32 flags; 2611 int tx_work = 0; 2612 struct ring_desc *orig_get_tx = np->get_tx.orig; 2613 unsigned int bytes_compl = 0; 2614 2615 while ((np->get_tx.orig != np->put_tx.orig) && 2616 !((flags = le32_to_cpu(np->get_tx.orig->flaglen)) & NV_TX_VALID) && 2617 (tx_work < limit)) { 2618 2619 nv_unmap_txskb(np, np->get_tx_ctx); 2620 2621 if (np->desc_ver == DESC_VER_1) { 2622 if (flags & NV_TX_LASTPACKET) { 2623 if (unlikely(flags & NV_TX_ERROR)) { 2624 if ((flags & NV_TX_RETRYERROR) 2625 && !(flags & NV_TX_RETRYCOUNT_MASK)) 2626 nv_legacybackoff_reseed(dev); 2627 } else { 2628 unsigned int len; 2629 2630 u64_stats_update_begin(&np->swstats_tx_syncp); 2631 nv_txrx_stats_inc(stat_tx_packets); 2632 len = np->get_tx_ctx->skb->len; 2633 nv_txrx_stats_add(stat_tx_bytes, len); 2634 u64_stats_update_end(&np->swstats_tx_syncp); 2635 } 2636 bytes_compl += np->get_tx_ctx->skb->len; 2637 dev_kfree_skb_any(np->get_tx_ctx->skb); 2638 np->get_tx_ctx->skb = NULL; 2639 tx_work++; 2640 } 2641 } else { 2642 if (flags & NV_TX2_LASTPACKET) { 2643 if (unlikely(flags & NV_TX2_ERROR)) { 2644 if ((flags & NV_TX2_RETRYERROR) 2645 && !(flags & NV_TX2_RETRYCOUNT_MASK)) 2646 nv_legacybackoff_reseed(dev); 2647 } else { 2648 unsigned int len; 2649 2650 u64_stats_update_begin(&np->swstats_tx_syncp); 2651 nv_txrx_stats_inc(stat_tx_packets); 2652 len = np->get_tx_ctx->skb->len; 2653 nv_txrx_stats_add(stat_tx_bytes, len); 2654 u64_stats_update_end(&np->swstats_tx_syncp); 2655 } 2656 bytes_compl += np->get_tx_ctx->skb->len; 2657 dev_kfree_skb_any(np->get_tx_ctx->skb); 2658 np->get_tx_ctx->skb = NULL; 2659 tx_work++; 2660 } 2661 } 2662 if (unlikely(np->get_tx.orig++ == np->last_tx.orig)) 2663 np->get_tx.orig = np->tx_ring.orig; 2664 if (unlikely(np->get_tx_ctx++ == np->last_tx_ctx)) 2665 np->get_tx_ctx = np->tx_skb; 2666 } 2667 2668 netdev_completed_queue(np->dev, tx_work, bytes_compl); 2669 2670 if (unlikely((np->tx_stop == 1) && (np->get_tx.orig != orig_get_tx))) { 2671 np->tx_stop = 0; 2672 netif_wake_queue(dev); 2673 } 2674 return tx_work; 2675 } 2676 2677 static int nv_tx_done_optimized(struct net_device *dev, int limit) 2678 { 2679 struct fe_priv *np = netdev_priv(dev); 2680 u32 flags; 2681 int tx_work = 0; 2682 struct ring_desc_ex *orig_get_tx = np->get_tx.ex; 2683 unsigned long bytes_cleaned = 0; 2684 2685 while ((np->get_tx.ex != np->put_tx.ex) && 2686 !((flags = le32_to_cpu(np->get_tx.ex->flaglen)) & NV_TX2_VALID) && 2687 (tx_work < limit)) { 2688 2689 nv_unmap_txskb(np, np->get_tx_ctx); 2690 2691 if (flags & NV_TX2_LASTPACKET) { 2692 if (unlikely(flags & NV_TX2_ERROR)) { 2693 if ((flags & NV_TX2_RETRYERROR) 2694 && !(flags & NV_TX2_RETRYCOUNT_MASK)) { 2695 if (np->driver_data & DEV_HAS_GEAR_MODE) 2696 nv_gear_backoff_reseed(dev); 2697 else 2698 nv_legacybackoff_reseed(dev); 2699 } 2700 } else { 2701 unsigned int len; 2702 2703 u64_stats_update_begin(&np->swstats_tx_syncp); 2704 nv_txrx_stats_inc(stat_tx_packets); 2705 len = np->get_tx_ctx->skb->len; 2706 nv_txrx_stats_add(stat_tx_bytes, len); 2707 u64_stats_update_end(&np->swstats_tx_syncp); 2708 } 2709 2710 bytes_cleaned += np->get_tx_ctx->skb->len; 2711 dev_kfree_skb_any(np->get_tx_ctx->skb); 2712 np->get_tx_ctx->skb = NULL; 2713 tx_work++; 2714 2715 if (np->tx_limit) 2716 nv_tx_flip_ownership(dev); 2717 } 2718 2719 if (unlikely(np->get_tx.ex++ == np->last_tx.ex)) 2720 np->get_tx.ex = np->tx_ring.ex; 2721 if (unlikely(np->get_tx_ctx++ == np->last_tx_ctx)) 2722 np->get_tx_ctx = np->tx_skb; 2723 } 2724 2725 netdev_completed_queue(np->dev, tx_work, bytes_cleaned); 2726 2727 if (unlikely((np->tx_stop == 1) && (np->get_tx.ex != orig_get_tx))) { 2728 np->tx_stop = 0; 2729 netif_wake_queue(dev); 2730 } 2731 return tx_work; 2732 } 2733 2734 /* 2735 * nv_tx_timeout: dev->tx_timeout function 2736 * Called with netif_tx_lock held. 2737 */ 2738 static void nv_tx_timeout(struct net_device *dev, unsigned int txqueue) 2739 { 2740 struct fe_priv *np = netdev_priv(dev); 2741 u8 __iomem *base = get_hwbase(dev); 2742 u32 status; 2743 union ring_type put_tx; 2744 int saved_tx_limit; 2745 2746 if (np->msi_flags & NV_MSI_X_ENABLED) 2747 status = readl(base + NvRegMSIXIrqStatus) & NVREG_IRQSTAT_MASK; 2748 else 2749 status = readl(base + NvRegIrqStatus) & NVREG_IRQSTAT_MASK; 2750 2751 netdev_warn(dev, "Got tx_timeout. irq status: %08x\n", status); 2752 2753 if (unlikely(debug_tx_timeout)) { 2754 int i; 2755 2756 netdev_info(dev, "Ring at %lx\n", (unsigned long)np->ring_addr); 2757 netdev_info(dev, "Dumping tx registers\n"); 2758 for (i = 0; i <= np->register_size; i += 32) { 2759 netdev_info(dev, 2760 "%3x: %08x %08x %08x %08x " 2761 "%08x %08x %08x %08x\n", 2762 i, 2763 readl(base + i + 0), readl(base + i + 4), 2764 readl(base + i + 8), readl(base + i + 12), 2765 readl(base + i + 16), readl(base + i + 20), 2766 readl(base + i + 24), readl(base + i + 28)); 2767 } 2768 netdev_info(dev, "Dumping tx ring\n"); 2769 for (i = 0; i < np->tx_ring_size; i += 4) { 2770 if (!nv_optimized(np)) { 2771 netdev_info(dev, 2772 "%03x: %08x %08x // %08x %08x " 2773 "// %08x %08x // %08x %08x\n", 2774 i, 2775 le32_to_cpu(np->tx_ring.orig[i].buf), 2776 le32_to_cpu(np->tx_ring.orig[i].flaglen), 2777 le32_to_cpu(np->tx_ring.orig[i+1].buf), 2778 le32_to_cpu(np->tx_ring.orig[i+1].flaglen), 2779 le32_to_cpu(np->tx_ring.orig[i+2].buf), 2780 le32_to_cpu(np->tx_ring.orig[i+2].flaglen), 2781 le32_to_cpu(np->tx_ring.orig[i+3].buf), 2782 le32_to_cpu(np->tx_ring.orig[i+3].flaglen)); 2783 } else { 2784 netdev_info(dev, 2785 "%03x: %08x %08x %08x " 2786 "// %08x %08x %08x " 2787 "// %08x %08x %08x " 2788 "// %08x %08x %08x\n", 2789 i, 2790 le32_to_cpu(np->tx_ring.ex[i].bufhigh), 2791 le32_to_cpu(np->tx_ring.ex[i].buflow), 2792 le32_to_cpu(np->tx_ring.ex[i].flaglen), 2793 le32_to_cpu(np->tx_ring.ex[i+1].bufhigh), 2794 le32_to_cpu(np->tx_ring.ex[i+1].buflow), 2795 le32_to_cpu(np->tx_ring.ex[i+1].flaglen), 2796 le32_to_cpu(np->tx_ring.ex[i+2].bufhigh), 2797 le32_to_cpu(np->tx_ring.ex[i+2].buflow), 2798 le32_to_cpu(np->tx_ring.ex[i+2].flaglen), 2799 le32_to_cpu(np->tx_ring.ex[i+3].bufhigh), 2800 le32_to_cpu(np->tx_ring.ex[i+3].buflow), 2801 le32_to_cpu(np->tx_ring.ex[i+3].flaglen)); 2802 } 2803 } 2804 } 2805 2806 spin_lock_irq(&np->lock); 2807 2808 /* 1) stop tx engine */ 2809 nv_stop_tx(dev); 2810 2811 /* 2) complete any outstanding tx and do not give HW any limited tx pkts */ 2812 saved_tx_limit = np->tx_limit; 2813 np->tx_limit = 0; /* prevent giving HW any limited pkts */ 2814 np->tx_stop = 0; /* prevent waking tx queue */ 2815 if (!nv_optimized(np)) 2816 nv_tx_done(dev, np->tx_ring_size); 2817 else 2818 nv_tx_done_optimized(dev, np->tx_ring_size); 2819 2820 /* save current HW position */ 2821 if (np->tx_change_owner) 2822 put_tx.ex = np->tx_change_owner->first_tx_desc; 2823 else 2824 put_tx = np->put_tx; 2825 2826 /* 3) clear all tx state */ 2827 nv_drain_tx(dev); 2828 nv_init_tx(dev); 2829 2830 /* 4) restore state to current HW position */ 2831 np->get_tx = np->put_tx = put_tx; 2832 np->tx_limit = saved_tx_limit; 2833 2834 /* 5) restart tx engine */ 2835 nv_start_tx(dev); 2836 netif_wake_queue(dev); 2837 spin_unlock_irq(&np->lock); 2838 } 2839 2840 /* 2841 * Called when the nic notices a mismatch between the actual data len on the 2842 * wire and the len indicated in the 802 header 2843 */ 2844 static int nv_getlen(struct net_device *dev, void *packet, int datalen) 2845 { 2846 int hdrlen; /* length of the 802 header */ 2847 int protolen; /* length as stored in the proto field */ 2848 2849 /* 1) calculate len according to header */ 2850 if (((struct vlan_ethhdr *)packet)->h_vlan_proto == htons(ETH_P_8021Q)) { 2851 protolen = ntohs(((struct vlan_ethhdr *)packet)->h_vlan_encapsulated_proto); 2852 hdrlen = VLAN_HLEN; 2853 } else { 2854 protolen = ntohs(((struct ethhdr *)packet)->h_proto); 2855 hdrlen = ETH_HLEN; 2856 } 2857 if (protolen > ETH_DATA_LEN) 2858 return datalen; /* Value in proto field not a len, no checks possible */ 2859 2860 protolen += hdrlen; 2861 /* consistency checks: */ 2862 if (datalen > ETH_ZLEN) { 2863 if (datalen >= protolen) { 2864 /* more data on wire than in 802 header, trim of 2865 * additional data. 2866 */ 2867 return protolen; 2868 } else { 2869 /* less data on wire than mentioned in header. 2870 * Discard the packet. 2871 */ 2872 return -1; 2873 } 2874 } else { 2875 /* short packet. Accept only if 802 values are also short */ 2876 if (protolen > ETH_ZLEN) { 2877 return -1; 2878 } 2879 return datalen; 2880 } 2881 } 2882 2883 static void rx_missing_handler(u32 flags, struct fe_priv *np) 2884 { 2885 if (flags & NV_RX_MISSEDFRAME) { 2886 u64_stats_update_begin(&np->swstats_rx_syncp); 2887 nv_txrx_stats_inc(stat_rx_missed_errors); 2888 u64_stats_update_end(&np->swstats_rx_syncp); 2889 } 2890 } 2891 2892 static int nv_rx_process(struct net_device *dev, int limit) 2893 { 2894 struct fe_priv *np = netdev_priv(dev); 2895 u32 flags; 2896 int rx_work = 0; 2897 struct sk_buff *skb; 2898 int len; 2899 2900 while ((np->get_rx.orig != np->put_rx.orig) && 2901 !((flags = le32_to_cpu(np->get_rx.orig->flaglen)) & NV_RX_AVAIL) && 2902 (rx_work < limit)) { 2903 2904 /* 2905 * the packet is for us - immediately tear down the pci mapping. 2906 * TODO: check if a prefetch of the first cacheline improves 2907 * the performance. 2908 */ 2909 dma_unmap_single(&np->pci_dev->dev, np->get_rx_ctx->dma, 2910 np->get_rx_ctx->dma_len, 2911 DMA_FROM_DEVICE); 2912 skb = np->get_rx_ctx->skb; 2913 np->get_rx_ctx->skb = NULL; 2914 2915 /* look at what we actually got: */ 2916 if (np->desc_ver == DESC_VER_1) { 2917 if (likely(flags & NV_RX_DESCRIPTORVALID)) { 2918 len = flags & LEN_MASK_V1; 2919 if (unlikely(flags & NV_RX_ERROR)) { 2920 if ((flags & NV_RX_ERROR_MASK) == NV_RX_ERROR4) { 2921 len = nv_getlen(dev, skb->data, len); 2922 if (len < 0) { 2923 dev_kfree_skb(skb); 2924 goto next_pkt; 2925 } 2926 } 2927 /* framing errors are soft errors */ 2928 else if ((flags & NV_RX_ERROR_MASK) == NV_RX_FRAMINGERR) { 2929 if (flags & NV_RX_SUBTRACT1) 2930 len--; 2931 } 2932 /* the rest are hard errors */ 2933 else { 2934 rx_missing_handler(flags, np); 2935 dev_kfree_skb(skb); 2936 goto next_pkt; 2937 } 2938 } 2939 } else { 2940 dev_kfree_skb(skb); 2941 goto next_pkt; 2942 } 2943 } else { 2944 if (likely(flags & NV_RX2_DESCRIPTORVALID)) { 2945 len = flags & LEN_MASK_V2; 2946 if (unlikely(flags & NV_RX2_ERROR)) { 2947 if ((flags & NV_RX2_ERROR_MASK) == NV_RX2_ERROR4) { 2948 len = nv_getlen(dev, skb->data, len); 2949 if (len < 0) { 2950 dev_kfree_skb(skb); 2951 goto next_pkt; 2952 } 2953 } 2954 /* framing errors are soft errors */ 2955 else if ((flags & NV_RX2_ERROR_MASK) == NV_RX2_FRAMINGERR) { 2956 if (flags & NV_RX2_SUBTRACT1) 2957 len--; 2958 } 2959 /* the rest are hard errors */ 2960 else { 2961 dev_kfree_skb(skb); 2962 goto next_pkt; 2963 } 2964 } 2965 if (((flags & NV_RX2_CHECKSUMMASK) == NV_RX2_CHECKSUM_IP_TCP) || /*ip and tcp */ 2966 ((flags & NV_RX2_CHECKSUMMASK) == NV_RX2_CHECKSUM_IP_UDP)) /*ip and udp */ 2967 skb->ip_summed = CHECKSUM_UNNECESSARY; 2968 } else { 2969 dev_kfree_skb(skb); 2970 goto next_pkt; 2971 } 2972 } 2973 /* got a valid packet - forward it to the network core */ 2974 skb_put(skb, len); 2975 skb->protocol = eth_type_trans(skb, dev); 2976 napi_gro_receive(&np->napi, skb); 2977 u64_stats_update_begin(&np->swstats_rx_syncp); 2978 nv_txrx_stats_inc(stat_rx_packets); 2979 nv_txrx_stats_add(stat_rx_bytes, len); 2980 u64_stats_update_end(&np->swstats_rx_syncp); 2981 next_pkt: 2982 if (unlikely(np->get_rx.orig++ == np->last_rx.orig)) 2983 np->get_rx.orig = np->rx_ring.orig; 2984 if (unlikely(np->get_rx_ctx++ == np->last_rx_ctx)) 2985 np->get_rx_ctx = np->rx_skb; 2986 2987 rx_work++; 2988 } 2989 2990 return rx_work; 2991 } 2992 2993 static int nv_rx_process_optimized(struct net_device *dev, int limit) 2994 { 2995 struct fe_priv *np = netdev_priv(dev); 2996 u32 flags; 2997 u32 vlanflags = 0; 2998 int rx_work = 0; 2999 struct sk_buff *skb; 3000 int len; 3001 3002 while ((np->get_rx.ex != np->put_rx.ex) && 3003 !((flags = le32_to_cpu(np->get_rx.ex->flaglen)) & NV_RX2_AVAIL) && 3004 (rx_work < limit)) { 3005 3006 /* 3007 * the packet is for us - immediately tear down the pci mapping. 3008 * TODO: check if a prefetch of the first cacheline improves 3009 * the performance. 3010 */ 3011 dma_unmap_single(&np->pci_dev->dev, np->get_rx_ctx->dma, 3012 np->get_rx_ctx->dma_len, 3013 DMA_FROM_DEVICE); 3014 skb = np->get_rx_ctx->skb; 3015 np->get_rx_ctx->skb = NULL; 3016 3017 /* look at what we actually got: */ 3018 if (likely(flags & NV_RX2_DESCRIPTORVALID)) { 3019 len = flags & LEN_MASK_V2; 3020 if (unlikely(flags & NV_RX2_ERROR)) { 3021 if ((flags & NV_RX2_ERROR_MASK) == NV_RX2_ERROR4) { 3022 len = nv_getlen(dev, skb->data, len); 3023 if (len < 0) { 3024 dev_kfree_skb(skb); 3025 goto next_pkt; 3026 } 3027 } 3028 /* framing errors are soft errors */ 3029 else if ((flags & NV_RX2_ERROR_MASK) == NV_RX2_FRAMINGERR) { 3030 if (flags & NV_RX2_SUBTRACT1) 3031 len--; 3032 } 3033 /* the rest are hard errors */ 3034 else { 3035 dev_kfree_skb(skb); 3036 goto next_pkt; 3037 } 3038 } 3039 3040 if (((flags & NV_RX2_CHECKSUMMASK) == NV_RX2_CHECKSUM_IP_TCP) || /*ip and tcp */ 3041 ((flags & NV_RX2_CHECKSUMMASK) == NV_RX2_CHECKSUM_IP_UDP)) /*ip and udp */ 3042 skb->ip_summed = CHECKSUM_UNNECESSARY; 3043 3044 /* got a valid packet - forward it to the network core */ 3045 skb_put(skb, len); 3046 skb->protocol = eth_type_trans(skb, dev); 3047 prefetch(skb->data); 3048 3049 vlanflags = le32_to_cpu(np->get_rx.ex->buflow); 3050 3051 /* 3052 * There's need to check for NETIF_F_HW_VLAN_CTAG_RX 3053 * here. Even if vlan rx accel is disabled, 3054 * NV_RX3_VLAN_TAG_PRESENT is pseudo randomly set. 3055 */ 3056 if (dev->features & NETIF_F_HW_VLAN_CTAG_RX && 3057 vlanflags & NV_RX3_VLAN_TAG_PRESENT) { 3058 u16 vid = vlanflags & NV_RX3_VLAN_TAG_MASK; 3059 3060 __vlan_hwaccel_put_tag(skb, htons(ETH_P_8021Q), vid); 3061 } 3062 napi_gro_receive(&np->napi, skb); 3063 u64_stats_update_begin(&np->swstats_rx_syncp); 3064 nv_txrx_stats_inc(stat_rx_packets); 3065 nv_txrx_stats_add(stat_rx_bytes, len); 3066 u64_stats_update_end(&np->swstats_rx_syncp); 3067 } else { 3068 dev_kfree_skb(skb); 3069 } 3070 next_pkt: 3071 if (unlikely(np->get_rx.ex++ == np->last_rx.ex)) 3072 np->get_rx.ex = np->rx_ring.ex; 3073 if (unlikely(np->get_rx_ctx++ == np->last_rx_ctx)) 3074 np->get_rx_ctx = np->rx_skb; 3075 3076 rx_work++; 3077 } 3078 3079 return rx_work; 3080 } 3081 3082 static void set_bufsize(struct net_device *dev) 3083 { 3084 struct fe_priv *np = netdev_priv(dev); 3085 3086 if (dev->mtu <= ETH_DATA_LEN) 3087 np->rx_buf_sz = ETH_DATA_LEN + NV_RX_HEADERS; 3088 else 3089 np->rx_buf_sz = dev->mtu + NV_RX_HEADERS; 3090 } 3091 3092 /* 3093 * nv_change_mtu: dev->change_mtu function 3094 * Called with dev_base_lock held for read. 3095 */ 3096 static int nv_change_mtu(struct net_device *dev, int new_mtu) 3097 { 3098 struct fe_priv *np = netdev_priv(dev); 3099 int old_mtu; 3100 3101 old_mtu = dev->mtu; 3102 dev->mtu = new_mtu; 3103 3104 /* return early if the buffer sizes will not change */ 3105 if (old_mtu <= ETH_DATA_LEN && new_mtu <= ETH_DATA_LEN) 3106 return 0; 3107 3108 /* synchronized against open : rtnl_lock() held by caller */ 3109 if (netif_running(dev)) { 3110 u8 __iomem *base = get_hwbase(dev); 3111 /* 3112 * It seems that the nic preloads valid ring entries into an 3113 * internal buffer. The procedure for flushing everything is 3114 * guessed, there is probably a simpler approach. 3115 * Changing the MTU is a rare event, it shouldn't matter. 3116 */ 3117 nv_disable_irq(dev); 3118 nv_napi_disable(dev); 3119 netif_tx_lock_bh(dev); 3120 netif_addr_lock(dev); 3121 spin_lock(&np->lock); 3122 /* stop engines */ 3123 nv_stop_rxtx(dev); 3124 nv_txrx_reset(dev); 3125 /* drain rx queue */ 3126 nv_drain_rxtx(dev); 3127 /* reinit driver view of the rx queue */ 3128 set_bufsize(dev); 3129 if (nv_init_ring(dev)) { 3130 if (!np->in_shutdown) 3131 mod_timer(&np->oom_kick, jiffies + OOM_REFILL); 3132 } 3133 /* reinit nic view of the rx queue */ 3134 writel(np->rx_buf_sz, base + NvRegOffloadConfig); 3135 setup_hw_rings(dev, NV_SETUP_RX_RING | NV_SETUP_TX_RING); 3136 writel(((np->rx_ring_size-1) << NVREG_RINGSZ_RXSHIFT) + ((np->tx_ring_size-1) << NVREG_RINGSZ_TXSHIFT), 3137 base + NvRegRingSizes); 3138 pci_push(base); 3139 writel(NVREG_TXRXCTL_KICK|np->txrxctl_bits, get_hwbase(dev) + NvRegTxRxControl); 3140 pci_push(base); 3141 3142 /* restart rx engine */ 3143 nv_start_rxtx(dev); 3144 spin_unlock(&np->lock); 3145 netif_addr_unlock(dev); 3146 netif_tx_unlock_bh(dev); 3147 nv_napi_enable(dev); 3148 nv_enable_irq(dev); 3149 } 3150 return 0; 3151 } 3152 3153 static void nv_copy_mac_to_hw(struct net_device *dev) 3154 { 3155 u8 __iomem *base = get_hwbase(dev); 3156 u32 mac[2]; 3157 3158 mac[0] = (dev->dev_addr[0] << 0) + (dev->dev_addr[1] << 8) + 3159 (dev->dev_addr[2] << 16) + (dev->dev_addr[3] << 24); 3160 mac[1] = (dev->dev_addr[4] << 0) + (dev->dev_addr[5] << 8); 3161 3162 writel(mac[0], base + NvRegMacAddrA); 3163 writel(mac[1], base + NvRegMacAddrB); 3164 } 3165 3166 /* 3167 * nv_set_mac_address: dev->set_mac_address function 3168 * Called with rtnl_lock() held. 3169 */ 3170 static int nv_set_mac_address(struct net_device *dev, void *addr) 3171 { 3172 struct fe_priv *np = netdev_priv(dev); 3173 struct sockaddr *macaddr = (struct sockaddr *)addr; 3174 3175 if (!is_valid_ether_addr(macaddr->sa_data)) 3176 return -EADDRNOTAVAIL; 3177 3178 /* synchronized against open : rtnl_lock() held by caller */ 3179 memcpy(dev->dev_addr, macaddr->sa_data, ETH_ALEN); 3180 3181 if (netif_running(dev)) { 3182 netif_tx_lock_bh(dev); 3183 netif_addr_lock(dev); 3184 spin_lock_irq(&np->lock); 3185 3186 /* stop rx engine */ 3187 nv_stop_rx(dev); 3188 3189 /* set mac address */ 3190 nv_copy_mac_to_hw(dev); 3191 3192 /* restart rx engine */ 3193 nv_start_rx(dev); 3194 spin_unlock_irq(&np->lock); 3195 netif_addr_unlock(dev); 3196 netif_tx_unlock_bh(dev); 3197 } else { 3198 nv_copy_mac_to_hw(dev); 3199 } 3200 return 0; 3201 } 3202 3203 /* 3204 * nv_set_multicast: dev->set_multicast function 3205 * Called with netif_tx_lock held. 3206 */ 3207 static void nv_set_multicast(struct net_device *dev) 3208 { 3209 struct fe_priv *np = netdev_priv(dev); 3210 u8 __iomem *base = get_hwbase(dev); 3211 u32 addr[2]; 3212 u32 mask[2]; 3213 u32 pff = readl(base + NvRegPacketFilterFlags) & NVREG_PFF_PAUSE_RX; 3214 3215 memset(addr, 0, sizeof(addr)); 3216 memset(mask, 0, sizeof(mask)); 3217 3218 if (dev->flags & IFF_PROMISC) { 3219 pff |= NVREG_PFF_PROMISC; 3220 } else { 3221 pff |= NVREG_PFF_MYADDR; 3222 3223 if (dev->flags & IFF_ALLMULTI || !netdev_mc_empty(dev)) { 3224 u32 alwaysOff[2]; 3225 u32 alwaysOn[2]; 3226 3227 alwaysOn[0] = alwaysOn[1] = alwaysOff[0] = alwaysOff[1] = 0xffffffff; 3228 if (dev->flags & IFF_ALLMULTI) { 3229 alwaysOn[0] = alwaysOn[1] = alwaysOff[0] = alwaysOff[1] = 0; 3230 } else { 3231 struct netdev_hw_addr *ha; 3232 3233 netdev_for_each_mc_addr(ha, dev) { 3234 unsigned char *hw_addr = ha->addr; 3235 u32 a, b; 3236 3237 a = le32_to_cpu(*(__le32 *) hw_addr); 3238 b = le16_to_cpu(*(__le16 *) (&hw_addr[4])); 3239 alwaysOn[0] &= a; 3240 alwaysOff[0] &= ~a; 3241 alwaysOn[1] &= b; 3242 alwaysOff[1] &= ~b; 3243 } 3244 } 3245 addr[0] = alwaysOn[0]; 3246 addr[1] = alwaysOn[1]; 3247 mask[0] = alwaysOn[0] | alwaysOff[0]; 3248 mask[1] = alwaysOn[1] | alwaysOff[1]; 3249 } else { 3250 mask[0] = NVREG_MCASTMASKA_NONE; 3251 mask[1] = NVREG_MCASTMASKB_NONE; 3252 } 3253 } 3254 addr[0] |= NVREG_MCASTADDRA_FORCE; 3255 pff |= NVREG_PFF_ALWAYS; 3256 spin_lock_irq(&np->lock); 3257 nv_stop_rx(dev); 3258 writel(addr[0], base + NvRegMulticastAddrA); 3259 writel(addr[1], base + NvRegMulticastAddrB); 3260 writel(mask[0], base + NvRegMulticastMaskA); 3261 writel(mask[1], base + NvRegMulticastMaskB); 3262 writel(pff, base + NvRegPacketFilterFlags); 3263 nv_start_rx(dev); 3264 spin_unlock_irq(&np->lock); 3265 } 3266 3267 static void nv_update_pause(struct net_device *dev, u32 pause_flags) 3268 { 3269 struct fe_priv *np = netdev_priv(dev); 3270 u8 __iomem *base = get_hwbase(dev); 3271 3272 np->pause_flags &= ~(NV_PAUSEFRAME_TX_ENABLE | NV_PAUSEFRAME_RX_ENABLE); 3273 3274 if (np->pause_flags & NV_PAUSEFRAME_RX_CAPABLE) { 3275 u32 pff = readl(base + NvRegPacketFilterFlags) & ~NVREG_PFF_PAUSE_RX; 3276 if (pause_flags & NV_PAUSEFRAME_RX_ENABLE) { 3277 writel(pff|NVREG_PFF_PAUSE_RX, base + NvRegPacketFilterFlags); 3278 np->pause_flags |= NV_PAUSEFRAME_RX_ENABLE; 3279 } else { 3280 writel(pff, base + NvRegPacketFilterFlags); 3281 } 3282 } 3283 if (np->pause_flags & NV_PAUSEFRAME_TX_CAPABLE) { 3284 u32 regmisc = readl(base + NvRegMisc1) & ~NVREG_MISC1_PAUSE_TX; 3285 if (pause_flags & NV_PAUSEFRAME_TX_ENABLE) { 3286 u32 pause_enable = NVREG_TX_PAUSEFRAME_ENABLE_V1; 3287 if (np->driver_data & DEV_HAS_PAUSEFRAME_TX_V2) 3288 pause_enable = NVREG_TX_PAUSEFRAME_ENABLE_V2; 3289 if (np->driver_data & DEV_HAS_PAUSEFRAME_TX_V3) { 3290 pause_enable = NVREG_TX_PAUSEFRAME_ENABLE_V3; 3291 /* limit the number of tx pause frames to a default of 8 */ 3292 writel(readl(base + NvRegTxPauseFrameLimit)|NVREG_TX_PAUSEFRAMELIMIT_ENABLE, base + NvRegTxPauseFrameLimit); 3293 } 3294 writel(pause_enable, base + NvRegTxPauseFrame); 3295 writel(regmisc|NVREG_MISC1_PAUSE_TX, base + NvRegMisc1); 3296 np->pause_flags |= NV_PAUSEFRAME_TX_ENABLE; 3297 } else { 3298 writel(NVREG_TX_PAUSEFRAME_DISABLE, base + NvRegTxPauseFrame); 3299 writel(regmisc, base + NvRegMisc1); 3300 } 3301 } 3302 } 3303 3304 static void nv_force_linkspeed(struct net_device *dev, int speed, int duplex) 3305 { 3306 struct fe_priv *np = netdev_priv(dev); 3307 u8 __iomem *base = get_hwbase(dev); 3308 u32 phyreg, txreg; 3309 int mii_status; 3310 3311 np->linkspeed = NVREG_LINKSPEED_FORCE|speed; 3312 np->duplex = duplex; 3313 3314 /* see if gigabit phy */ 3315 mii_status = mii_rw(dev, np->phyaddr, MII_BMSR, MII_READ); 3316 if (mii_status & PHY_GIGABIT) { 3317 np->gigabit = PHY_GIGABIT; 3318 phyreg = readl(base + NvRegSlotTime); 3319 phyreg &= ~(0x3FF00); 3320 if ((np->linkspeed & 0xFFF) == NVREG_LINKSPEED_10) 3321 phyreg |= NVREG_SLOTTIME_10_100_FULL; 3322 else if ((np->linkspeed & 0xFFF) == NVREG_LINKSPEED_100) 3323 phyreg |= NVREG_SLOTTIME_10_100_FULL; 3324 else if ((np->linkspeed & 0xFFF) == NVREG_LINKSPEED_1000) 3325 phyreg |= NVREG_SLOTTIME_1000_FULL; 3326 writel(phyreg, base + NvRegSlotTime); 3327 } 3328 3329 phyreg = readl(base + NvRegPhyInterface); 3330 phyreg &= ~(PHY_HALF|PHY_100|PHY_1000); 3331 if (np->duplex == 0) 3332 phyreg |= PHY_HALF; 3333 if ((np->linkspeed & NVREG_LINKSPEED_MASK) == NVREG_LINKSPEED_100) 3334 phyreg |= PHY_100; 3335 else if ((np->linkspeed & NVREG_LINKSPEED_MASK) == 3336 NVREG_LINKSPEED_1000) 3337 phyreg |= PHY_1000; 3338 writel(phyreg, base + NvRegPhyInterface); 3339 3340 if (phyreg & PHY_RGMII) { 3341 if ((np->linkspeed & NVREG_LINKSPEED_MASK) == 3342 NVREG_LINKSPEED_1000) 3343 txreg = NVREG_TX_DEFERRAL_RGMII_1000; 3344 else 3345 txreg = NVREG_TX_DEFERRAL_RGMII_10_100; 3346 } else { 3347 txreg = NVREG_TX_DEFERRAL_DEFAULT; 3348 } 3349 writel(txreg, base + NvRegTxDeferral); 3350 3351 if (np->desc_ver == DESC_VER_1) { 3352 txreg = NVREG_TX_WM_DESC1_DEFAULT; 3353 } else { 3354 if ((np->linkspeed & NVREG_LINKSPEED_MASK) == 3355 NVREG_LINKSPEED_1000) 3356 txreg = NVREG_TX_WM_DESC2_3_1000; 3357 else 3358 txreg = NVREG_TX_WM_DESC2_3_DEFAULT; 3359 } 3360 writel(txreg, base + NvRegTxWatermark); 3361 3362 writel(NVREG_MISC1_FORCE | (np->duplex ? 0 : NVREG_MISC1_HD), 3363 base + NvRegMisc1); 3364 pci_push(base); 3365 writel(np->linkspeed, base + NvRegLinkSpeed); 3366 pci_push(base); 3367 } 3368 3369 /** 3370 * nv_update_linkspeed - Setup the MAC according to the link partner 3371 * @dev: Network device to be configured 3372 * 3373 * The function queries the PHY and checks if there is a link partner. 3374 * If yes, then it sets up the MAC accordingly. Otherwise, the MAC is 3375 * set to 10 MBit HD. 3376 * 3377 * The function returns 0 if there is no link partner and 1 if there is 3378 * a good link partner. 3379 */ 3380 static int nv_update_linkspeed(struct net_device *dev) 3381 { 3382 struct fe_priv *np = netdev_priv(dev); 3383 u8 __iomem *base = get_hwbase(dev); 3384 int adv = 0; 3385 int lpa = 0; 3386 int adv_lpa, adv_pause, lpa_pause; 3387 int newls = np->linkspeed; 3388 int newdup = np->duplex; 3389 int mii_status; 3390 u32 bmcr; 3391 int retval = 0; 3392 u32 control_1000, status_1000, phyreg, pause_flags, txreg; 3393 u32 txrxFlags = 0; 3394 u32 phy_exp; 3395 3396 /* If device loopback is enabled, set carrier on and enable max link 3397 * speed. 3398 */ 3399 bmcr = mii_rw(dev, np->phyaddr, MII_BMCR, MII_READ); 3400 if (bmcr & BMCR_LOOPBACK) { 3401 if (netif_running(dev)) { 3402 nv_force_linkspeed(dev, NVREG_LINKSPEED_1000, 1); 3403 if (!netif_carrier_ok(dev)) 3404 netif_carrier_on(dev); 3405 } 3406 return 1; 3407 } 3408 3409 /* BMSR_LSTATUS is latched, read it twice: 3410 * we want the current value. 3411 */ 3412 mii_rw(dev, np->phyaddr, MII_BMSR, MII_READ); 3413 mii_status = mii_rw(dev, np->phyaddr, MII_BMSR, MII_READ); 3414 3415 if (!(mii_status & BMSR_LSTATUS)) { 3416 newls = NVREG_LINKSPEED_FORCE|NVREG_LINKSPEED_10; 3417 newdup = 0; 3418 retval = 0; 3419 goto set_speed; 3420 } 3421 3422 if (np->autoneg == 0) { 3423 if (np->fixed_mode & LPA_100FULL) { 3424 newls = NVREG_LINKSPEED_FORCE|NVREG_LINKSPEED_100; 3425 newdup = 1; 3426 } else if (np->fixed_mode & LPA_100HALF) { 3427 newls = NVREG_LINKSPEED_FORCE|NVREG_LINKSPEED_100; 3428 newdup = 0; 3429 } else if (np->fixed_mode & LPA_10FULL) { 3430 newls = NVREG_LINKSPEED_FORCE|NVREG_LINKSPEED_10; 3431 newdup = 1; 3432 } else { 3433 newls = NVREG_LINKSPEED_FORCE|NVREG_LINKSPEED_10; 3434 newdup = 0; 3435 } 3436 retval = 1; 3437 goto set_speed; 3438 } 3439 /* check auto negotiation is complete */ 3440 if (!(mii_status & BMSR_ANEGCOMPLETE)) { 3441 /* still in autonegotiation - configure nic for 10 MBit HD and wait. */ 3442 newls = NVREG_LINKSPEED_FORCE|NVREG_LINKSPEED_10; 3443 newdup = 0; 3444 retval = 0; 3445 goto set_speed; 3446 } 3447 3448 adv = mii_rw(dev, np->phyaddr, MII_ADVERTISE, MII_READ); 3449 lpa = mii_rw(dev, np->phyaddr, MII_LPA, MII_READ); 3450 3451 retval = 1; 3452 if (np->gigabit == PHY_GIGABIT) { 3453 control_1000 = mii_rw(dev, np->phyaddr, MII_CTRL1000, MII_READ); 3454 status_1000 = mii_rw(dev, np->phyaddr, MII_STAT1000, MII_READ); 3455 3456 if ((control_1000 & ADVERTISE_1000FULL) && 3457 (status_1000 & LPA_1000FULL)) { 3458 newls = NVREG_LINKSPEED_FORCE|NVREG_LINKSPEED_1000; 3459 newdup = 1; 3460 goto set_speed; 3461 } 3462 } 3463 3464 /* FIXME: handle parallel detection properly */ 3465 adv_lpa = lpa & adv; 3466 if (adv_lpa & LPA_100FULL) { 3467 newls = NVREG_LINKSPEED_FORCE|NVREG_LINKSPEED_100; 3468 newdup = 1; 3469 } else if (adv_lpa & LPA_100HALF) { 3470 newls = NVREG_LINKSPEED_FORCE|NVREG_LINKSPEED_100; 3471 newdup = 0; 3472 } else if (adv_lpa & LPA_10FULL) { 3473 newls = NVREG_LINKSPEED_FORCE|NVREG_LINKSPEED_10; 3474 newdup = 1; 3475 } else if (adv_lpa & LPA_10HALF) { 3476 newls = NVREG_LINKSPEED_FORCE|NVREG_LINKSPEED_10; 3477 newdup = 0; 3478 } else { 3479 newls = NVREG_LINKSPEED_FORCE|NVREG_LINKSPEED_10; 3480 newdup = 0; 3481 } 3482 3483 set_speed: 3484 if (np->duplex == newdup && np->linkspeed == newls) 3485 return retval; 3486 3487 np->duplex = newdup; 3488 np->linkspeed = newls; 3489 3490 /* The transmitter and receiver must be restarted for safe update */ 3491 if (readl(base + NvRegTransmitterControl) & NVREG_XMITCTL_START) { 3492 txrxFlags |= NV_RESTART_TX; 3493 nv_stop_tx(dev); 3494 } 3495 if (readl(base + NvRegReceiverControl) & NVREG_RCVCTL_START) { 3496 txrxFlags |= NV_RESTART_RX; 3497 nv_stop_rx(dev); 3498 } 3499 3500 if (np->gigabit == PHY_GIGABIT) { 3501 phyreg = readl(base + NvRegSlotTime); 3502 phyreg &= ~(0x3FF00); 3503 if (((np->linkspeed & 0xFFF) == NVREG_LINKSPEED_10) || 3504 ((np->linkspeed & 0xFFF) == NVREG_LINKSPEED_100)) 3505 phyreg |= NVREG_SLOTTIME_10_100_FULL; 3506 else if ((np->linkspeed & 0xFFF) == NVREG_LINKSPEED_1000) 3507 phyreg |= NVREG_SLOTTIME_1000_FULL; 3508 writel(phyreg, base + NvRegSlotTime); 3509 } 3510 3511 phyreg = readl(base + NvRegPhyInterface); 3512 phyreg &= ~(PHY_HALF|PHY_100|PHY_1000); 3513 if (np->duplex == 0) 3514 phyreg |= PHY_HALF; 3515 if ((np->linkspeed & NVREG_LINKSPEED_MASK) == NVREG_LINKSPEED_100) 3516 phyreg |= PHY_100; 3517 else if ((np->linkspeed & NVREG_LINKSPEED_MASK) == NVREG_LINKSPEED_1000) 3518 phyreg |= PHY_1000; 3519 writel(phyreg, base + NvRegPhyInterface); 3520 3521 phy_exp = mii_rw(dev, np->phyaddr, MII_EXPANSION, MII_READ) & EXPANSION_NWAY; /* autoneg capable */ 3522 if (phyreg & PHY_RGMII) { 3523 if ((np->linkspeed & NVREG_LINKSPEED_MASK) == NVREG_LINKSPEED_1000) { 3524 txreg = NVREG_TX_DEFERRAL_RGMII_1000; 3525 } else { 3526 if (!phy_exp && !np->duplex && (np->driver_data & DEV_HAS_COLLISION_FIX)) { 3527 if ((np->linkspeed & NVREG_LINKSPEED_MASK) == NVREG_LINKSPEED_10) 3528 txreg = NVREG_TX_DEFERRAL_RGMII_STRETCH_10; 3529 else 3530 txreg = NVREG_TX_DEFERRAL_RGMII_STRETCH_100; 3531 } else { 3532 txreg = NVREG_TX_DEFERRAL_RGMII_10_100; 3533 } 3534 } 3535 } else { 3536 if (!phy_exp && !np->duplex && (np->driver_data & DEV_HAS_COLLISION_FIX)) 3537 txreg = NVREG_TX_DEFERRAL_MII_STRETCH; 3538 else 3539 txreg = NVREG_TX_DEFERRAL_DEFAULT; 3540 } 3541 writel(txreg, base + NvRegTxDeferral); 3542 3543 if (np->desc_ver == DESC_VER_1) { 3544 txreg = NVREG_TX_WM_DESC1_DEFAULT; 3545 } else { 3546 if ((np->linkspeed & NVREG_LINKSPEED_MASK) == NVREG_LINKSPEED_1000) 3547 txreg = NVREG_TX_WM_DESC2_3_1000; 3548 else 3549 txreg = NVREG_TX_WM_DESC2_3_DEFAULT; 3550 } 3551 writel(txreg, base + NvRegTxWatermark); 3552 3553 writel(NVREG_MISC1_FORCE | (np->duplex ? 0 : NVREG_MISC1_HD), 3554 base + NvRegMisc1); 3555 pci_push(base); 3556 writel(np->linkspeed, base + NvRegLinkSpeed); 3557 pci_push(base); 3558 3559 pause_flags = 0; 3560 /* setup pause frame */ 3561 if (netif_running(dev) && (np->duplex != 0)) { 3562 if (np->autoneg && np->pause_flags & NV_PAUSEFRAME_AUTONEG) { 3563 adv_pause = adv & (ADVERTISE_PAUSE_CAP | ADVERTISE_PAUSE_ASYM); 3564 lpa_pause = lpa & (LPA_PAUSE_CAP | LPA_PAUSE_ASYM); 3565 3566 switch (adv_pause) { 3567 case ADVERTISE_PAUSE_CAP: 3568 if (lpa_pause & LPA_PAUSE_CAP) { 3569 pause_flags |= NV_PAUSEFRAME_RX_ENABLE; 3570 if (np->pause_flags & NV_PAUSEFRAME_TX_REQ) 3571 pause_flags |= NV_PAUSEFRAME_TX_ENABLE; 3572 } 3573 break; 3574 case ADVERTISE_PAUSE_ASYM: 3575 if (lpa_pause == (LPA_PAUSE_CAP | LPA_PAUSE_ASYM)) 3576 pause_flags |= NV_PAUSEFRAME_TX_ENABLE; 3577 break; 3578 case ADVERTISE_PAUSE_CAP | ADVERTISE_PAUSE_ASYM: 3579 if (lpa_pause & LPA_PAUSE_CAP) { 3580 pause_flags |= NV_PAUSEFRAME_RX_ENABLE; 3581 if (np->pause_flags & NV_PAUSEFRAME_TX_REQ) 3582 pause_flags |= NV_PAUSEFRAME_TX_ENABLE; 3583 } 3584 if (lpa_pause == LPA_PAUSE_ASYM) 3585 pause_flags |= NV_PAUSEFRAME_RX_ENABLE; 3586 break; 3587 } 3588 } else { 3589 pause_flags = np->pause_flags; 3590 } 3591 } 3592 nv_update_pause(dev, pause_flags); 3593 3594 if (txrxFlags & NV_RESTART_TX) 3595 nv_start_tx(dev); 3596 if (txrxFlags & NV_RESTART_RX) 3597 nv_start_rx(dev); 3598 3599 return retval; 3600 } 3601 3602 static void nv_linkchange(struct net_device *dev) 3603 { 3604 if (nv_update_linkspeed(dev)) { 3605 if (!netif_carrier_ok(dev)) { 3606 netif_carrier_on(dev); 3607 netdev_info(dev, "link up\n"); 3608 nv_txrx_gate(dev, false); 3609 nv_start_rx(dev); 3610 } 3611 } else { 3612 if (netif_carrier_ok(dev)) { 3613 netif_carrier_off(dev); 3614 netdev_info(dev, "link down\n"); 3615 nv_txrx_gate(dev, true); 3616 nv_stop_rx(dev); 3617 } 3618 } 3619 } 3620 3621 static void nv_link_irq(struct net_device *dev) 3622 { 3623 u8 __iomem *base = get_hwbase(dev); 3624 u32 miistat; 3625 3626 miistat = readl(base + NvRegMIIStatus); 3627 writel(NVREG_MIISTAT_LINKCHANGE, base + NvRegMIIStatus); 3628 3629 if (miistat & (NVREG_MIISTAT_LINKCHANGE)) 3630 nv_linkchange(dev); 3631 } 3632 3633 static void nv_msi_workaround(struct fe_priv *np) 3634 { 3635 3636 /* Need to toggle the msi irq mask within the ethernet device, 3637 * otherwise, future interrupts will not be detected. 3638 */ 3639 if (np->msi_flags & NV_MSI_ENABLED) { 3640 u8 __iomem *base = np->base; 3641 3642 writel(0, base + NvRegMSIIrqMask); 3643 writel(NVREG_MSI_VECTOR_0_ENABLED, base + NvRegMSIIrqMask); 3644 } 3645 } 3646 3647 static inline int nv_change_interrupt_mode(struct net_device *dev, int total_work) 3648 { 3649 struct fe_priv *np = netdev_priv(dev); 3650 3651 if (optimization_mode == NV_OPTIMIZATION_MODE_DYNAMIC) { 3652 if (total_work > NV_DYNAMIC_THRESHOLD) { 3653 /* transition to poll based interrupts */ 3654 np->quiet_count = 0; 3655 if (np->irqmask != NVREG_IRQMASK_CPU) { 3656 np->irqmask = NVREG_IRQMASK_CPU; 3657 return 1; 3658 } 3659 } else { 3660 if (np->quiet_count < NV_DYNAMIC_MAX_QUIET_COUNT) { 3661 np->quiet_count++; 3662 } else { 3663 /* reached a period of low activity, switch 3664 to per tx/rx packet interrupts */ 3665 if (np->irqmask != NVREG_IRQMASK_THROUGHPUT) { 3666 np->irqmask = NVREG_IRQMASK_THROUGHPUT; 3667 return 1; 3668 } 3669 } 3670 } 3671 } 3672 return 0; 3673 } 3674 3675 static irqreturn_t nv_nic_irq(int foo, void *data) 3676 { 3677 struct net_device *dev = (struct net_device *) data; 3678 struct fe_priv *np = netdev_priv(dev); 3679 u8 __iomem *base = get_hwbase(dev); 3680 3681 if (!(np->msi_flags & NV_MSI_X_ENABLED)) { 3682 np->events = readl(base + NvRegIrqStatus); 3683 writel(np->events, base + NvRegIrqStatus); 3684 } else { 3685 np->events = readl(base + NvRegMSIXIrqStatus); 3686 writel(np->events, base + NvRegMSIXIrqStatus); 3687 } 3688 if (!(np->events & np->irqmask)) 3689 return IRQ_NONE; 3690 3691 nv_msi_workaround(np); 3692 3693 if (napi_schedule_prep(&np->napi)) { 3694 /* 3695 * Disable further irq's (msix not enabled with napi) 3696 */ 3697 writel(0, base + NvRegIrqMask); 3698 __napi_schedule(&np->napi); 3699 } 3700 3701 return IRQ_HANDLED; 3702 } 3703 3704 /* All _optimized functions are used to help increase performance 3705 * (reduce CPU and increase throughput). They use descripter version 3, 3706 * compiler directives, and reduce memory accesses. 3707 */ 3708 static irqreturn_t nv_nic_irq_optimized(int foo, void *data) 3709 { 3710 struct net_device *dev = (struct net_device *) data; 3711 struct fe_priv *np = netdev_priv(dev); 3712 u8 __iomem *base = get_hwbase(dev); 3713 3714 if (!(np->msi_flags & NV_MSI_X_ENABLED)) { 3715 np->events = readl(base + NvRegIrqStatus); 3716 writel(np->events, base + NvRegIrqStatus); 3717 } else { 3718 np->events = readl(base + NvRegMSIXIrqStatus); 3719 writel(np->events, base + NvRegMSIXIrqStatus); 3720 } 3721 if (!(np->events & np->irqmask)) 3722 return IRQ_NONE; 3723 3724 nv_msi_workaround(np); 3725 3726 if (napi_schedule_prep(&np->napi)) { 3727 /* 3728 * Disable further irq's (msix not enabled with napi) 3729 */ 3730 writel(0, base + NvRegIrqMask); 3731 __napi_schedule(&np->napi); 3732 } 3733 3734 return IRQ_HANDLED; 3735 } 3736 3737 static irqreturn_t nv_nic_irq_tx(int foo, void *data) 3738 { 3739 struct net_device *dev = (struct net_device *) data; 3740 struct fe_priv *np = netdev_priv(dev); 3741 u8 __iomem *base = get_hwbase(dev); 3742 u32 events; 3743 int i; 3744 unsigned long flags; 3745 3746 for (i = 0;; i++) { 3747 events = readl(base + NvRegMSIXIrqStatus) & NVREG_IRQ_TX_ALL; 3748 writel(events, base + NvRegMSIXIrqStatus); 3749 netdev_dbg(dev, "tx irq events: %08x\n", events); 3750 if (!(events & np->irqmask)) 3751 break; 3752 3753 spin_lock_irqsave(&np->lock, flags); 3754 nv_tx_done_optimized(dev, TX_WORK_PER_LOOP); 3755 spin_unlock_irqrestore(&np->lock, flags); 3756 3757 if (unlikely(i > max_interrupt_work)) { 3758 spin_lock_irqsave(&np->lock, flags); 3759 /* disable interrupts on the nic */ 3760 writel(NVREG_IRQ_TX_ALL, base + NvRegIrqMask); 3761 pci_push(base); 3762 3763 if (!np->in_shutdown) { 3764 np->nic_poll_irq |= NVREG_IRQ_TX_ALL; 3765 mod_timer(&np->nic_poll, jiffies + POLL_WAIT); 3766 } 3767 spin_unlock_irqrestore(&np->lock, flags); 3768 netdev_dbg(dev, "%s: too many iterations (%d)\n", 3769 __func__, i); 3770 break; 3771 } 3772 3773 } 3774 3775 return IRQ_RETVAL(i); 3776 } 3777 3778 static int nv_napi_poll(struct napi_struct *napi, int budget) 3779 { 3780 struct fe_priv *np = container_of(napi, struct fe_priv, napi); 3781 struct net_device *dev = np->dev; 3782 u8 __iomem *base = get_hwbase(dev); 3783 unsigned long flags; 3784 int retcode; 3785 int rx_count, tx_work = 0, rx_work = 0; 3786 3787 do { 3788 if (!nv_optimized(np)) { 3789 spin_lock_irqsave(&np->lock, flags); 3790 tx_work += nv_tx_done(dev, np->tx_ring_size); 3791 spin_unlock_irqrestore(&np->lock, flags); 3792 3793 rx_count = nv_rx_process(dev, budget - rx_work); 3794 retcode = nv_alloc_rx(dev); 3795 } else { 3796 spin_lock_irqsave(&np->lock, flags); 3797 tx_work += nv_tx_done_optimized(dev, np->tx_ring_size); 3798 spin_unlock_irqrestore(&np->lock, flags); 3799 3800 rx_count = nv_rx_process_optimized(dev, 3801 budget - rx_work); 3802 retcode = nv_alloc_rx_optimized(dev); 3803 } 3804 } while (retcode == 0 && 3805 rx_count > 0 && (rx_work += rx_count) < budget); 3806 3807 if (retcode) { 3808 spin_lock_irqsave(&np->lock, flags); 3809 if (!np->in_shutdown) 3810 mod_timer(&np->oom_kick, jiffies + OOM_REFILL); 3811 spin_unlock_irqrestore(&np->lock, flags); 3812 } 3813 3814 nv_change_interrupt_mode(dev, tx_work + rx_work); 3815 3816 if (unlikely(np->events & NVREG_IRQ_LINK)) { 3817 spin_lock_irqsave(&np->lock, flags); 3818 nv_link_irq(dev); 3819 spin_unlock_irqrestore(&np->lock, flags); 3820 } 3821 if (unlikely(np->need_linktimer && time_after(jiffies, np->link_timeout))) { 3822 spin_lock_irqsave(&np->lock, flags); 3823 nv_linkchange(dev); 3824 spin_unlock_irqrestore(&np->lock, flags); 3825 np->link_timeout = jiffies + LINK_TIMEOUT; 3826 } 3827 if (unlikely(np->events & NVREG_IRQ_RECOVER_ERROR)) { 3828 spin_lock_irqsave(&np->lock, flags); 3829 if (!np->in_shutdown) { 3830 np->nic_poll_irq = np->irqmask; 3831 np->recover_error = 1; 3832 mod_timer(&np->nic_poll, jiffies + POLL_WAIT); 3833 } 3834 spin_unlock_irqrestore(&np->lock, flags); 3835 napi_complete(napi); 3836 return rx_work; 3837 } 3838 3839 if (rx_work < budget) { 3840 /* re-enable interrupts 3841 (msix not enabled in napi) */ 3842 napi_complete_done(napi, rx_work); 3843 3844 writel(np->irqmask, base + NvRegIrqMask); 3845 } 3846 return rx_work; 3847 } 3848 3849 static irqreturn_t nv_nic_irq_rx(int foo, void *data) 3850 { 3851 struct net_device *dev = (struct net_device *) data; 3852 struct fe_priv *np = netdev_priv(dev); 3853 u8 __iomem *base = get_hwbase(dev); 3854 u32 events; 3855 int i; 3856 unsigned long flags; 3857 3858 for (i = 0;; i++) { 3859 events = readl(base + NvRegMSIXIrqStatus) & NVREG_IRQ_RX_ALL; 3860 writel(events, base + NvRegMSIXIrqStatus); 3861 netdev_dbg(dev, "rx irq events: %08x\n", events); 3862 if (!(events & np->irqmask)) 3863 break; 3864 3865 if (nv_rx_process_optimized(dev, RX_WORK_PER_LOOP)) { 3866 if (unlikely(nv_alloc_rx_optimized(dev))) { 3867 spin_lock_irqsave(&np->lock, flags); 3868 if (!np->in_shutdown) 3869 mod_timer(&np->oom_kick, jiffies + OOM_REFILL); 3870 spin_unlock_irqrestore(&np->lock, flags); 3871 } 3872 } 3873 3874 if (unlikely(i > max_interrupt_work)) { 3875 spin_lock_irqsave(&np->lock, flags); 3876 /* disable interrupts on the nic */ 3877 writel(NVREG_IRQ_RX_ALL, base + NvRegIrqMask); 3878 pci_push(base); 3879 3880 if (!np->in_shutdown) { 3881 np->nic_poll_irq |= NVREG_IRQ_RX_ALL; 3882 mod_timer(&np->nic_poll, jiffies + POLL_WAIT); 3883 } 3884 spin_unlock_irqrestore(&np->lock, flags); 3885 netdev_dbg(dev, "%s: too many iterations (%d)\n", 3886 __func__, i); 3887 break; 3888 } 3889 } 3890 3891 return IRQ_RETVAL(i); 3892 } 3893 3894 static irqreturn_t nv_nic_irq_other(int foo, void *data) 3895 { 3896 struct net_device *dev = (struct net_device *) data; 3897 struct fe_priv *np = netdev_priv(dev); 3898 u8 __iomem *base = get_hwbase(dev); 3899 u32 events; 3900 int i; 3901 unsigned long flags; 3902 3903 for (i = 0;; i++) { 3904 events = readl(base + NvRegMSIXIrqStatus) & NVREG_IRQ_OTHER; 3905 writel(events, base + NvRegMSIXIrqStatus); 3906 netdev_dbg(dev, "irq events: %08x\n", events); 3907 if (!(events & np->irqmask)) 3908 break; 3909 3910 /* check tx in case we reached max loop limit in tx isr */ 3911 spin_lock_irqsave(&np->lock, flags); 3912 nv_tx_done_optimized(dev, TX_WORK_PER_LOOP); 3913 spin_unlock_irqrestore(&np->lock, flags); 3914 3915 if (events & NVREG_IRQ_LINK) { 3916 spin_lock_irqsave(&np->lock, flags); 3917 nv_link_irq(dev); 3918 spin_unlock_irqrestore(&np->lock, flags); 3919 } 3920 if (np->need_linktimer && time_after(jiffies, np->link_timeout)) { 3921 spin_lock_irqsave(&np->lock, flags); 3922 nv_linkchange(dev); 3923 spin_unlock_irqrestore(&np->lock, flags); 3924 np->link_timeout = jiffies + LINK_TIMEOUT; 3925 } 3926 if (events & NVREG_IRQ_RECOVER_ERROR) { 3927 spin_lock_irqsave(&np->lock, flags); 3928 /* disable interrupts on the nic */ 3929 writel(NVREG_IRQ_OTHER, base + NvRegIrqMask); 3930 pci_push(base); 3931 3932 if (!np->in_shutdown) { 3933 np->nic_poll_irq |= NVREG_IRQ_OTHER; 3934 np->recover_error = 1; 3935 mod_timer(&np->nic_poll, jiffies + POLL_WAIT); 3936 } 3937 spin_unlock_irqrestore(&np->lock, flags); 3938 break; 3939 } 3940 if (unlikely(i > max_interrupt_work)) { 3941 spin_lock_irqsave(&np->lock, flags); 3942 /* disable interrupts on the nic */ 3943 writel(NVREG_IRQ_OTHER, base + NvRegIrqMask); 3944 pci_push(base); 3945 3946 if (!np->in_shutdown) { 3947 np->nic_poll_irq |= NVREG_IRQ_OTHER; 3948 mod_timer(&np->nic_poll, jiffies + POLL_WAIT); 3949 } 3950 spin_unlock_irqrestore(&np->lock, flags); 3951 netdev_dbg(dev, "%s: too many iterations (%d)\n", 3952 __func__, i); 3953 break; 3954 } 3955 3956 } 3957 3958 return IRQ_RETVAL(i); 3959 } 3960 3961 static irqreturn_t nv_nic_irq_test(int foo, void *data) 3962 { 3963 struct net_device *dev = (struct net_device *) data; 3964 struct fe_priv *np = netdev_priv(dev); 3965 u8 __iomem *base = get_hwbase(dev); 3966 u32 events; 3967 3968 if (!(np->msi_flags & NV_MSI_X_ENABLED)) { 3969 events = readl(base + NvRegIrqStatus) & NVREG_IRQSTAT_MASK; 3970 writel(events & NVREG_IRQ_TIMER, base + NvRegIrqStatus); 3971 } else { 3972 events = readl(base + NvRegMSIXIrqStatus) & NVREG_IRQSTAT_MASK; 3973 writel(events & NVREG_IRQ_TIMER, base + NvRegMSIXIrqStatus); 3974 } 3975 pci_push(base); 3976 if (!(events & NVREG_IRQ_TIMER)) 3977 return IRQ_RETVAL(0); 3978 3979 nv_msi_workaround(np); 3980 3981 spin_lock(&np->lock); 3982 np->intr_test = 1; 3983 spin_unlock(&np->lock); 3984 3985 return IRQ_RETVAL(1); 3986 } 3987 3988 static void set_msix_vector_map(struct net_device *dev, u32 vector, u32 irqmask) 3989 { 3990 u8 __iomem *base = get_hwbase(dev); 3991 int i; 3992 u32 msixmap = 0; 3993 3994 /* Each interrupt bit can be mapped to a MSIX vector (4 bits). 3995 * MSIXMap0 represents the first 8 interrupts and MSIXMap1 represents 3996 * the remaining 8 interrupts. 3997 */ 3998 for (i = 0; i < 8; i++) { 3999 if ((irqmask >> i) & 0x1) 4000 msixmap |= vector << (i << 2); 4001 } 4002 writel(readl(base + NvRegMSIXMap0) | msixmap, base + NvRegMSIXMap0); 4003 4004 msixmap = 0; 4005 for (i = 0; i < 8; i++) { 4006 if ((irqmask >> (i + 8)) & 0x1) 4007 msixmap |= vector << (i << 2); 4008 } 4009 writel(readl(base + NvRegMSIXMap1) | msixmap, base + NvRegMSIXMap1); 4010 } 4011 4012 static int nv_request_irq(struct net_device *dev, int intr_test) 4013 { 4014 struct fe_priv *np = get_nvpriv(dev); 4015 u8 __iomem *base = get_hwbase(dev); 4016 int ret; 4017 int i; 4018 irqreturn_t (*handler)(int foo, void *data); 4019 4020 if (intr_test) { 4021 handler = nv_nic_irq_test; 4022 } else { 4023 if (nv_optimized(np)) 4024 handler = nv_nic_irq_optimized; 4025 else 4026 handler = nv_nic_irq; 4027 } 4028 4029 if (np->msi_flags & NV_MSI_X_CAPABLE) { 4030 for (i = 0; i < (np->msi_flags & NV_MSI_X_VECTORS_MASK); i++) 4031 np->msi_x_entry[i].entry = i; 4032 ret = pci_enable_msix_range(np->pci_dev, 4033 np->msi_x_entry, 4034 np->msi_flags & NV_MSI_X_VECTORS_MASK, 4035 np->msi_flags & NV_MSI_X_VECTORS_MASK); 4036 if (ret > 0) { 4037 np->msi_flags |= NV_MSI_X_ENABLED; 4038 if (optimization_mode == NV_OPTIMIZATION_MODE_THROUGHPUT && !intr_test) { 4039 /* Request irq for rx handling */ 4040 sprintf(np->name_rx, "%s-rx", dev->name); 4041 ret = request_irq(np->msi_x_entry[NV_MSI_X_VECTOR_RX].vector, 4042 nv_nic_irq_rx, IRQF_SHARED, np->name_rx, dev); 4043 if (ret) { 4044 netdev_info(dev, 4045 "request_irq failed for rx %d\n", 4046 ret); 4047 pci_disable_msix(np->pci_dev); 4048 np->msi_flags &= ~NV_MSI_X_ENABLED; 4049 goto out_err; 4050 } 4051 /* Request irq for tx handling */ 4052 sprintf(np->name_tx, "%s-tx", dev->name); 4053 ret = request_irq(np->msi_x_entry[NV_MSI_X_VECTOR_TX].vector, 4054 nv_nic_irq_tx, IRQF_SHARED, np->name_tx, dev); 4055 if (ret) { 4056 netdev_info(dev, 4057 "request_irq failed for tx %d\n", 4058 ret); 4059 pci_disable_msix(np->pci_dev); 4060 np->msi_flags &= ~NV_MSI_X_ENABLED; 4061 goto out_free_rx; 4062 } 4063 /* Request irq for link and timer handling */ 4064 sprintf(np->name_other, "%s-other", dev->name); 4065 ret = request_irq(np->msi_x_entry[NV_MSI_X_VECTOR_OTHER].vector, 4066 nv_nic_irq_other, IRQF_SHARED, np->name_other, dev); 4067 if (ret) { 4068 netdev_info(dev, 4069 "request_irq failed for link %d\n", 4070 ret); 4071 pci_disable_msix(np->pci_dev); 4072 np->msi_flags &= ~NV_MSI_X_ENABLED; 4073 goto out_free_tx; 4074 } 4075 /* map interrupts to their respective vector */ 4076 writel(0, base + NvRegMSIXMap0); 4077 writel(0, base + NvRegMSIXMap1); 4078 set_msix_vector_map(dev, NV_MSI_X_VECTOR_RX, NVREG_IRQ_RX_ALL); 4079 set_msix_vector_map(dev, NV_MSI_X_VECTOR_TX, NVREG_IRQ_TX_ALL); 4080 set_msix_vector_map(dev, NV_MSI_X_VECTOR_OTHER, NVREG_IRQ_OTHER); 4081 } else { 4082 /* Request irq for all interrupts */ 4083 ret = request_irq(np->msi_x_entry[NV_MSI_X_VECTOR_ALL].vector, 4084 handler, IRQF_SHARED, dev->name, dev); 4085 if (ret) { 4086 netdev_info(dev, 4087 "request_irq failed %d\n", 4088 ret); 4089 pci_disable_msix(np->pci_dev); 4090 np->msi_flags &= ~NV_MSI_X_ENABLED; 4091 goto out_err; 4092 } 4093 4094 /* map interrupts to vector 0 */ 4095 writel(0, base + NvRegMSIXMap0); 4096 writel(0, base + NvRegMSIXMap1); 4097 } 4098 netdev_info(dev, "MSI-X enabled\n"); 4099 return 0; 4100 } 4101 } 4102 if (np->msi_flags & NV_MSI_CAPABLE) { 4103 ret = pci_enable_msi(np->pci_dev); 4104 if (ret == 0) { 4105 np->msi_flags |= NV_MSI_ENABLED; 4106 ret = request_irq(np->pci_dev->irq, handler, IRQF_SHARED, dev->name, dev); 4107 if (ret) { 4108 netdev_info(dev, "request_irq failed %d\n", 4109 ret); 4110 pci_disable_msi(np->pci_dev); 4111 np->msi_flags &= ~NV_MSI_ENABLED; 4112 goto out_err; 4113 } 4114 4115 /* map interrupts to vector 0 */ 4116 writel(0, base + NvRegMSIMap0); 4117 writel(0, base + NvRegMSIMap1); 4118 /* enable msi vector 0 */ 4119 writel(NVREG_MSI_VECTOR_0_ENABLED, base + NvRegMSIIrqMask); 4120 netdev_info(dev, "MSI enabled\n"); 4121 return 0; 4122 } 4123 } 4124 4125 if (request_irq(np->pci_dev->irq, handler, IRQF_SHARED, dev->name, dev) != 0) 4126 goto out_err; 4127 4128 return 0; 4129 out_free_tx: 4130 free_irq(np->msi_x_entry[NV_MSI_X_VECTOR_TX].vector, dev); 4131 out_free_rx: 4132 free_irq(np->msi_x_entry[NV_MSI_X_VECTOR_RX].vector, dev); 4133 out_err: 4134 return 1; 4135 } 4136 4137 static void nv_free_irq(struct net_device *dev) 4138 { 4139 struct fe_priv *np = get_nvpriv(dev); 4140 int i; 4141 4142 if (np->msi_flags & NV_MSI_X_ENABLED) { 4143 for (i = 0; i < (np->msi_flags & NV_MSI_X_VECTORS_MASK); i++) 4144 free_irq(np->msi_x_entry[i].vector, dev); 4145 pci_disable_msix(np->pci_dev); 4146 np->msi_flags &= ~NV_MSI_X_ENABLED; 4147 } else { 4148 free_irq(np->pci_dev->irq, dev); 4149 if (np->msi_flags & NV_MSI_ENABLED) { 4150 pci_disable_msi(np->pci_dev); 4151 np->msi_flags &= ~NV_MSI_ENABLED; 4152 } 4153 } 4154 } 4155 4156 static void nv_do_nic_poll(struct timer_list *t) 4157 { 4158 struct fe_priv *np = from_timer(np, t, nic_poll); 4159 struct net_device *dev = np->dev; 4160 u8 __iomem *base = get_hwbase(dev); 4161 u32 mask = 0; 4162 unsigned long flags; 4163 unsigned int irq = 0; 4164 4165 /* 4166 * First disable irq(s) and then 4167 * reenable interrupts on the nic, we have to do this before calling 4168 * nv_nic_irq because that may decide to do otherwise 4169 */ 4170 4171 if (!using_multi_irqs(dev)) { 4172 if (np->msi_flags & NV_MSI_X_ENABLED) 4173 irq = np->msi_x_entry[NV_MSI_X_VECTOR_ALL].vector; 4174 else 4175 irq = np->pci_dev->irq; 4176 mask = np->irqmask; 4177 } else { 4178 if (np->nic_poll_irq & NVREG_IRQ_RX_ALL) { 4179 irq = np->msi_x_entry[NV_MSI_X_VECTOR_RX].vector; 4180 mask |= NVREG_IRQ_RX_ALL; 4181 } 4182 if (np->nic_poll_irq & NVREG_IRQ_TX_ALL) { 4183 irq = np->msi_x_entry[NV_MSI_X_VECTOR_TX].vector; 4184 mask |= NVREG_IRQ_TX_ALL; 4185 } 4186 if (np->nic_poll_irq & NVREG_IRQ_OTHER) { 4187 irq = np->msi_x_entry[NV_MSI_X_VECTOR_OTHER].vector; 4188 mask |= NVREG_IRQ_OTHER; 4189 } 4190 } 4191 4192 disable_irq_nosync_lockdep_irqsave(irq, &flags); 4193 synchronize_irq(irq); 4194 4195 if (np->recover_error) { 4196 np->recover_error = 0; 4197 netdev_info(dev, "MAC in recoverable error state\n"); 4198 if (netif_running(dev)) { 4199 netif_tx_lock_bh(dev); 4200 netif_addr_lock(dev); 4201 spin_lock(&np->lock); 4202 /* stop engines */ 4203 nv_stop_rxtx(dev); 4204 if (np->driver_data & DEV_HAS_POWER_CNTRL) 4205 nv_mac_reset(dev); 4206 nv_txrx_reset(dev); 4207 /* drain rx queue */ 4208 nv_drain_rxtx(dev); 4209 /* reinit driver view of the rx queue */ 4210 set_bufsize(dev); 4211 if (nv_init_ring(dev)) { 4212 if (!np->in_shutdown) 4213 mod_timer(&np->oom_kick, jiffies + OOM_REFILL); 4214 } 4215 /* reinit nic view of the rx queue */ 4216 writel(np->rx_buf_sz, base + NvRegOffloadConfig); 4217 setup_hw_rings(dev, NV_SETUP_RX_RING | NV_SETUP_TX_RING); 4218 writel(((np->rx_ring_size-1) << NVREG_RINGSZ_RXSHIFT) + ((np->tx_ring_size-1) << NVREG_RINGSZ_TXSHIFT), 4219 base + NvRegRingSizes); 4220 pci_push(base); 4221 writel(NVREG_TXRXCTL_KICK|np->txrxctl_bits, get_hwbase(dev) + NvRegTxRxControl); 4222 pci_push(base); 4223 /* clear interrupts */ 4224 if (!(np->msi_flags & NV_MSI_X_ENABLED)) 4225 writel(NVREG_IRQSTAT_MASK, base + NvRegIrqStatus); 4226 else 4227 writel(NVREG_IRQSTAT_MASK, base + NvRegMSIXIrqStatus); 4228 4229 /* restart rx engine */ 4230 nv_start_rxtx(dev); 4231 spin_unlock(&np->lock); 4232 netif_addr_unlock(dev); 4233 netif_tx_unlock_bh(dev); 4234 } 4235 } 4236 4237 writel(mask, base + NvRegIrqMask); 4238 pci_push(base); 4239 4240 if (!using_multi_irqs(dev)) { 4241 np->nic_poll_irq = 0; 4242 if (nv_optimized(np)) 4243 nv_nic_irq_optimized(0, dev); 4244 else 4245 nv_nic_irq(0, dev); 4246 } else { 4247 if (np->nic_poll_irq & NVREG_IRQ_RX_ALL) { 4248 np->nic_poll_irq &= ~NVREG_IRQ_RX_ALL; 4249 nv_nic_irq_rx(0, dev); 4250 } 4251 if (np->nic_poll_irq & NVREG_IRQ_TX_ALL) { 4252 np->nic_poll_irq &= ~NVREG_IRQ_TX_ALL; 4253 nv_nic_irq_tx(0, dev); 4254 } 4255 if (np->nic_poll_irq & NVREG_IRQ_OTHER) { 4256 np->nic_poll_irq &= ~NVREG_IRQ_OTHER; 4257 nv_nic_irq_other(0, dev); 4258 } 4259 } 4260 4261 enable_irq_lockdep_irqrestore(irq, &flags); 4262 } 4263 4264 #ifdef CONFIG_NET_POLL_CONTROLLER 4265 static void nv_poll_controller(struct net_device *dev) 4266 { 4267 struct fe_priv *np = netdev_priv(dev); 4268 4269 nv_do_nic_poll(&np->nic_poll); 4270 } 4271 #endif 4272 4273 static void nv_do_stats_poll(struct timer_list *t) 4274 __acquires(&netdev_priv(dev)->hwstats_lock) 4275 __releases(&netdev_priv(dev)->hwstats_lock) 4276 { 4277 struct fe_priv *np = from_timer(np, t, stats_poll); 4278 struct net_device *dev = np->dev; 4279 4280 /* If lock is currently taken, the stats are being refreshed 4281 * and hence fresh enough */ 4282 if (spin_trylock(&np->hwstats_lock)) { 4283 nv_update_stats(dev); 4284 spin_unlock(&np->hwstats_lock); 4285 } 4286 4287 if (!np->in_shutdown) 4288 mod_timer(&np->stats_poll, 4289 round_jiffies(jiffies + STATS_INTERVAL)); 4290 } 4291 4292 static void nv_get_drvinfo(struct net_device *dev, struct ethtool_drvinfo *info) 4293 { 4294 struct fe_priv *np = netdev_priv(dev); 4295 strlcpy(info->driver, DRV_NAME, sizeof(info->driver)); 4296 strlcpy(info->version, FORCEDETH_VERSION, sizeof(info->version)); 4297 strlcpy(info->bus_info, pci_name(np->pci_dev), sizeof(info->bus_info)); 4298 } 4299 4300 static void nv_get_wol(struct net_device *dev, struct ethtool_wolinfo *wolinfo) 4301 { 4302 struct fe_priv *np = netdev_priv(dev); 4303 wolinfo->supported = WAKE_MAGIC; 4304 4305 spin_lock_irq(&np->lock); 4306 if (np->wolenabled) 4307 wolinfo->wolopts = WAKE_MAGIC; 4308 spin_unlock_irq(&np->lock); 4309 } 4310 4311 static int nv_set_wol(struct net_device *dev, struct ethtool_wolinfo *wolinfo) 4312 { 4313 struct fe_priv *np = netdev_priv(dev); 4314 u8 __iomem *base = get_hwbase(dev); 4315 u32 flags = 0; 4316 4317 if (wolinfo->wolopts == 0) { 4318 np->wolenabled = 0; 4319 } else if (wolinfo->wolopts & WAKE_MAGIC) { 4320 np->wolenabled = 1; 4321 flags = NVREG_WAKEUPFLAGS_ENABLE; 4322 } 4323 if (netif_running(dev)) { 4324 spin_lock_irq(&np->lock); 4325 writel(flags, base + NvRegWakeUpFlags); 4326 spin_unlock_irq(&np->lock); 4327 } 4328 device_set_wakeup_enable(&np->pci_dev->dev, np->wolenabled); 4329 return 0; 4330 } 4331 4332 static int nv_get_link_ksettings(struct net_device *dev, 4333 struct ethtool_link_ksettings *cmd) 4334 { 4335 struct fe_priv *np = netdev_priv(dev); 4336 u32 speed, supported, advertising; 4337 int adv; 4338 4339 spin_lock_irq(&np->lock); 4340 cmd->base.port = PORT_MII; 4341 if (!netif_running(dev)) { 4342 /* We do not track link speed / duplex setting if the 4343 * interface is disabled. Force a link check */ 4344 if (nv_update_linkspeed(dev)) { 4345 netif_carrier_on(dev); 4346 } else { 4347 netif_carrier_off(dev); 4348 } 4349 } 4350 4351 if (netif_carrier_ok(dev)) { 4352 switch (np->linkspeed & (NVREG_LINKSPEED_MASK)) { 4353 case NVREG_LINKSPEED_10: 4354 speed = SPEED_10; 4355 break; 4356 case NVREG_LINKSPEED_100: 4357 speed = SPEED_100; 4358 break; 4359 case NVREG_LINKSPEED_1000: 4360 speed = SPEED_1000; 4361 break; 4362 default: 4363 speed = -1; 4364 break; 4365 } 4366 cmd->base.duplex = DUPLEX_HALF; 4367 if (np->duplex) 4368 cmd->base.duplex = DUPLEX_FULL; 4369 } else { 4370 speed = SPEED_UNKNOWN; 4371 cmd->base.duplex = DUPLEX_UNKNOWN; 4372 } 4373 cmd->base.speed = speed; 4374 cmd->base.autoneg = np->autoneg; 4375 4376 advertising = ADVERTISED_MII; 4377 if (np->autoneg) { 4378 advertising |= ADVERTISED_Autoneg; 4379 adv = mii_rw(dev, np->phyaddr, MII_ADVERTISE, MII_READ); 4380 if (adv & ADVERTISE_10HALF) 4381 advertising |= ADVERTISED_10baseT_Half; 4382 if (adv & ADVERTISE_10FULL) 4383 advertising |= ADVERTISED_10baseT_Full; 4384 if (adv & ADVERTISE_100HALF) 4385 advertising |= ADVERTISED_100baseT_Half; 4386 if (adv & ADVERTISE_100FULL) 4387 advertising |= ADVERTISED_100baseT_Full; 4388 if (np->gigabit == PHY_GIGABIT) { 4389 adv = mii_rw(dev, np->phyaddr, MII_CTRL1000, MII_READ); 4390 if (adv & ADVERTISE_1000FULL) 4391 advertising |= ADVERTISED_1000baseT_Full; 4392 } 4393 } 4394 supported = (SUPPORTED_Autoneg | 4395 SUPPORTED_10baseT_Half | SUPPORTED_10baseT_Full | 4396 SUPPORTED_100baseT_Half | SUPPORTED_100baseT_Full | 4397 SUPPORTED_MII); 4398 if (np->gigabit == PHY_GIGABIT) 4399 supported |= SUPPORTED_1000baseT_Full; 4400 4401 cmd->base.phy_address = np->phyaddr; 4402 4403 ethtool_convert_legacy_u32_to_link_mode(cmd->link_modes.supported, 4404 supported); 4405 ethtool_convert_legacy_u32_to_link_mode(cmd->link_modes.advertising, 4406 advertising); 4407 4408 /* ignore maxtxpkt, maxrxpkt for now */ 4409 spin_unlock_irq(&np->lock); 4410 return 0; 4411 } 4412 4413 static int nv_set_link_ksettings(struct net_device *dev, 4414 const struct ethtool_link_ksettings *cmd) 4415 { 4416 struct fe_priv *np = netdev_priv(dev); 4417 u32 speed = cmd->base.speed; 4418 u32 advertising; 4419 4420 ethtool_convert_link_mode_to_legacy_u32(&advertising, 4421 cmd->link_modes.advertising); 4422 4423 if (cmd->base.port != PORT_MII) 4424 return -EINVAL; 4425 if (cmd->base.phy_address != np->phyaddr) { 4426 /* TODO: support switching between multiple phys. Should be 4427 * trivial, but not enabled due to lack of test hardware. */ 4428 return -EINVAL; 4429 } 4430 if (cmd->base.autoneg == AUTONEG_ENABLE) { 4431 u32 mask; 4432 4433 mask = ADVERTISED_10baseT_Half | ADVERTISED_10baseT_Full | 4434 ADVERTISED_100baseT_Half | ADVERTISED_100baseT_Full; 4435 if (np->gigabit == PHY_GIGABIT) 4436 mask |= ADVERTISED_1000baseT_Full; 4437 4438 if ((advertising & mask) == 0) 4439 return -EINVAL; 4440 4441 } else if (cmd->base.autoneg == AUTONEG_DISABLE) { 4442 /* Note: autonegotiation disable, speed 1000 intentionally 4443 * forbidden - no one should need that. */ 4444 4445 if (speed != SPEED_10 && speed != SPEED_100) 4446 return -EINVAL; 4447 if (cmd->base.duplex != DUPLEX_HALF && 4448 cmd->base.duplex != DUPLEX_FULL) 4449 return -EINVAL; 4450 } else { 4451 return -EINVAL; 4452 } 4453 4454 netif_carrier_off(dev); 4455 if (netif_running(dev)) { 4456 unsigned long flags; 4457 4458 nv_disable_irq(dev); 4459 netif_tx_lock_bh(dev); 4460 netif_addr_lock(dev); 4461 /* with plain spinlock lockdep complains */ 4462 spin_lock_irqsave(&np->lock, flags); 4463 /* stop engines */ 4464 /* FIXME: 4465 * this can take some time, and interrupts are disabled 4466 * due to spin_lock_irqsave, but let's hope no daemon 4467 * is going to change the settings very often... 4468 * Worst case: 4469 * NV_RXSTOP_DELAY1MAX + NV_TXSTOP_DELAY1MAX 4470 * + some minor delays, which is up to a second approximately 4471 */ 4472 nv_stop_rxtx(dev); 4473 spin_unlock_irqrestore(&np->lock, flags); 4474 netif_addr_unlock(dev); 4475 netif_tx_unlock_bh(dev); 4476 } 4477 4478 if (cmd->base.autoneg == AUTONEG_ENABLE) { 4479 int adv, bmcr; 4480 4481 np->autoneg = 1; 4482 4483 /* advertise only what has been requested */ 4484 adv = mii_rw(dev, np->phyaddr, MII_ADVERTISE, MII_READ); 4485 adv &= ~(ADVERTISE_ALL | ADVERTISE_100BASE4 | ADVERTISE_PAUSE_CAP | ADVERTISE_PAUSE_ASYM); 4486 if (advertising & ADVERTISED_10baseT_Half) 4487 adv |= ADVERTISE_10HALF; 4488 if (advertising & ADVERTISED_10baseT_Full) 4489 adv |= ADVERTISE_10FULL; 4490 if (advertising & ADVERTISED_100baseT_Half) 4491 adv |= ADVERTISE_100HALF; 4492 if (advertising & ADVERTISED_100baseT_Full) 4493 adv |= ADVERTISE_100FULL; 4494 if (np->pause_flags & NV_PAUSEFRAME_RX_REQ) /* for rx we set both advertisements but disable tx pause */ 4495 adv |= ADVERTISE_PAUSE_CAP | ADVERTISE_PAUSE_ASYM; 4496 if (np->pause_flags & NV_PAUSEFRAME_TX_REQ) 4497 adv |= ADVERTISE_PAUSE_ASYM; 4498 mii_rw(dev, np->phyaddr, MII_ADVERTISE, adv); 4499 4500 if (np->gigabit == PHY_GIGABIT) { 4501 adv = mii_rw(dev, np->phyaddr, MII_CTRL1000, MII_READ); 4502 adv &= ~ADVERTISE_1000FULL; 4503 if (advertising & ADVERTISED_1000baseT_Full) 4504 adv |= ADVERTISE_1000FULL; 4505 mii_rw(dev, np->phyaddr, MII_CTRL1000, adv); 4506 } 4507 4508 if (netif_running(dev)) 4509 netdev_info(dev, "link down\n"); 4510 bmcr = mii_rw(dev, np->phyaddr, MII_BMCR, MII_READ); 4511 if (np->phy_model == PHY_MODEL_MARVELL_E3016) { 4512 bmcr |= BMCR_ANENABLE; 4513 /* reset the phy in order for settings to stick, 4514 * and cause autoneg to start */ 4515 if (phy_reset(dev, bmcr)) { 4516 netdev_info(dev, "phy reset failed\n"); 4517 return -EINVAL; 4518 } 4519 } else { 4520 bmcr |= (BMCR_ANENABLE | BMCR_ANRESTART); 4521 mii_rw(dev, np->phyaddr, MII_BMCR, bmcr); 4522 } 4523 } else { 4524 int adv, bmcr; 4525 4526 np->autoneg = 0; 4527 4528 adv = mii_rw(dev, np->phyaddr, MII_ADVERTISE, MII_READ); 4529 adv &= ~(ADVERTISE_ALL | ADVERTISE_100BASE4 | ADVERTISE_PAUSE_CAP | ADVERTISE_PAUSE_ASYM); 4530 if (speed == SPEED_10 && cmd->base.duplex == DUPLEX_HALF) 4531 adv |= ADVERTISE_10HALF; 4532 if (speed == SPEED_10 && cmd->base.duplex == DUPLEX_FULL) 4533 adv |= ADVERTISE_10FULL; 4534 if (speed == SPEED_100 && cmd->base.duplex == DUPLEX_HALF) 4535 adv |= ADVERTISE_100HALF; 4536 if (speed == SPEED_100 && cmd->base.duplex == DUPLEX_FULL) 4537 adv |= ADVERTISE_100FULL; 4538 np->pause_flags &= ~(NV_PAUSEFRAME_AUTONEG|NV_PAUSEFRAME_RX_ENABLE|NV_PAUSEFRAME_TX_ENABLE); 4539 if (np->pause_flags & NV_PAUSEFRAME_RX_REQ) {/* for rx we set both advertisements but disable tx pause */ 4540 adv |= ADVERTISE_PAUSE_CAP | ADVERTISE_PAUSE_ASYM; 4541 np->pause_flags |= NV_PAUSEFRAME_RX_ENABLE; 4542 } 4543 if (np->pause_flags & NV_PAUSEFRAME_TX_REQ) { 4544 adv |= ADVERTISE_PAUSE_ASYM; 4545 np->pause_flags |= NV_PAUSEFRAME_TX_ENABLE; 4546 } 4547 mii_rw(dev, np->phyaddr, MII_ADVERTISE, adv); 4548 np->fixed_mode = adv; 4549 4550 if (np->gigabit == PHY_GIGABIT) { 4551 adv = mii_rw(dev, np->phyaddr, MII_CTRL1000, MII_READ); 4552 adv &= ~ADVERTISE_1000FULL; 4553 mii_rw(dev, np->phyaddr, MII_CTRL1000, adv); 4554 } 4555 4556 bmcr = mii_rw(dev, np->phyaddr, MII_BMCR, MII_READ); 4557 bmcr &= ~(BMCR_ANENABLE|BMCR_SPEED100|BMCR_SPEED1000|BMCR_FULLDPLX); 4558 if (np->fixed_mode & (ADVERTISE_10FULL|ADVERTISE_100FULL)) 4559 bmcr |= BMCR_FULLDPLX; 4560 if (np->fixed_mode & (ADVERTISE_100HALF|ADVERTISE_100FULL)) 4561 bmcr |= BMCR_SPEED100; 4562 if (np->phy_oui == PHY_OUI_MARVELL) { 4563 /* reset the phy in order for forced mode settings to stick */ 4564 if (phy_reset(dev, bmcr)) { 4565 netdev_info(dev, "phy reset failed\n"); 4566 return -EINVAL; 4567 } 4568 } else { 4569 mii_rw(dev, np->phyaddr, MII_BMCR, bmcr); 4570 if (netif_running(dev)) { 4571 /* Wait a bit and then reconfigure the nic. */ 4572 udelay(10); 4573 nv_linkchange(dev); 4574 } 4575 } 4576 } 4577 4578 if (netif_running(dev)) { 4579 nv_start_rxtx(dev); 4580 nv_enable_irq(dev); 4581 } 4582 4583 return 0; 4584 } 4585 4586 #define FORCEDETH_REGS_VER 1 4587 4588 static int nv_get_regs_len(struct net_device *dev) 4589 { 4590 struct fe_priv *np = netdev_priv(dev); 4591 return np->register_size; 4592 } 4593 4594 static void nv_get_regs(struct net_device *dev, struct ethtool_regs *regs, void *buf) 4595 { 4596 struct fe_priv *np = netdev_priv(dev); 4597 u8 __iomem *base = get_hwbase(dev); 4598 u32 *rbuf = buf; 4599 int i; 4600 4601 regs->version = FORCEDETH_REGS_VER; 4602 spin_lock_irq(&np->lock); 4603 for (i = 0; i < np->register_size/sizeof(u32); i++) 4604 rbuf[i] = readl(base + i*sizeof(u32)); 4605 spin_unlock_irq(&np->lock); 4606 } 4607 4608 static int nv_nway_reset(struct net_device *dev) 4609 { 4610 struct fe_priv *np = netdev_priv(dev); 4611 int ret; 4612 4613 if (np->autoneg) { 4614 int bmcr; 4615 4616 netif_carrier_off(dev); 4617 if (netif_running(dev)) { 4618 nv_disable_irq(dev); 4619 netif_tx_lock_bh(dev); 4620 netif_addr_lock(dev); 4621 spin_lock(&np->lock); 4622 /* stop engines */ 4623 nv_stop_rxtx(dev); 4624 spin_unlock(&np->lock); 4625 netif_addr_unlock(dev); 4626 netif_tx_unlock_bh(dev); 4627 netdev_info(dev, "link down\n"); 4628 } 4629 4630 bmcr = mii_rw(dev, np->phyaddr, MII_BMCR, MII_READ); 4631 if (np->phy_model == PHY_MODEL_MARVELL_E3016) { 4632 bmcr |= BMCR_ANENABLE; 4633 /* reset the phy in order for settings to stick*/ 4634 if (phy_reset(dev, bmcr)) { 4635 netdev_info(dev, "phy reset failed\n"); 4636 return -EINVAL; 4637 } 4638 } else { 4639 bmcr |= (BMCR_ANENABLE | BMCR_ANRESTART); 4640 mii_rw(dev, np->phyaddr, MII_BMCR, bmcr); 4641 } 4642 4643 if (netif_running(dev)) { 4644 nv_start_rxtx(dev); 4645 nv_enable_irq(dev); 4646 } 4647 ret = 0; 4648 } else { 4649 ret = -EINVAL; 4650 } 4651 4652 return ret; 4653 } 4654 4655 static void nv_get_ringparam(struct net_device *dev, struct ethtool_ringparam* ring) 4656 { 4657 struct fe_priv *np = netdev_priv(dev); 4658 4659 ring->rx_max_pending = (np->desc_ver == DESC_VER_1) ? RING_MAX_DESC_VER_1 : RING_MAX_DESC_VER_2_3; 4660 ring->tx_max_pending = (np->desc_ver == DESC_VER_1) ? RING_MAX_DESC_VER_1 : RING_MAX_DESC_VER_2_3; 4661 4662 ring->rx_pending = np->rx_ring_size; 4663 ring->tx_pending = np->tx_ring_size; 4664 } 4665 4666 static int nv_set_ringparam(struct net_device *dev, struct ethtool_ringparam* ring) 4667 { 4668 struct fe_priv *np = netdev_priv(dev); 4669 u8 __iomem *base = get_hwbase(dev); 4670 u8 *rxtx_ring, *rx_skbuff, *tx_skbuff; 4671 dma_addr_t ring_addr; 4672 4673 if (ring->rx_pending < RX_RING_MIN || 4674 ring->tx_pending < TX_RING_MIN || 4675 ring->rx_mini_pending != 0 || 4676 ring->rx_jumbo_pending != 0 || 4677 (np->desc_ver == DESC_VER_1 && 4678 (ring->rx_pending > RING_MAX_DESC_VER_1 || 4679 ring->tx_pending > RING_MAX_DESC_VER_1)) || 4680 (np->desc_ver != DESC_VER_1 && 4681 (ring->rx_pending > RING_MAX_DESC_VER_2_3 || 4682 ring->tx_pending > RING_MAX_DESC_VER_2_3))) { 4683 return -EINVAL; 4684 } 4685 4686 /* allocate new rings */ 4687 if (!nv_optimized(np)) { 4688 rxtx_ring = dma_alloc_coherent(&np->pci_dev->dev, 4689 sizeof(struct ring_desc) * 4690 (ring->rx_pending + 4691 ring->tx_pending), 4692 &ring_addr, GFP_ATOMIC); 4693 } else { 4694 rxtx_ring = dma_alloc_coherent(&np->pci_dev->dev, 4695 sizeof(struct ring_desc_ex) * 4696 (ring->rx_pending + 4697 ring->tx_pending), 4698 &ring_addr, GFP_ATOMIC); 4699 } 4700 rx_skbuff = kmalloc_array(ring->rx_pending, sizeof(struct nv_skb_map), 4701 GFP_KERNEL); 4702 tx_skbuff = kmalloc_array(ring->tx_pending, sizeof(struct nv_skb_map), 4703 GFP_KERNEL); 4704 if (!rxtx_ring || !rx_skbuff || !tx_skbuff) { 4705 /* fall back to old rings */ 4706 if (!nv_optimized(np)) { 4707 if (rxtx_ring) 4708 dma_free_coherent(&np->pci_dev->dev, 4709 sizeof(struct ring_desc) * 4710 (ring->rx_pending + 4711 ring->tx_pending), 4712 rxtx_ring, ring_addr); 4713 } else { 4714 if (rxtx_ring) 4715 dma_free_coherent(&np->pci_dev->dev, 4716 sizeof(struct ring_desc_ex) * 4717 (ring->rx_pending + 4718 ring->tx_pending), 4719 rxtx_ring, ring_addr); 4720 } 4721 4722 kfree(rx_skbuff); 4723 kfree(tx_skbuff); 4724 goto exit; 4725 } 4726 4727 if (netif_running(dev)) { 4728 nv_disable_irq(dev); 4729 nv_napi_disable(dev); 4730 netif_tx_lock_bh(dev); 4731 netif_addr_lock(dev); 4732 spin_lock(&np->lock); 4733 /* stop engines */ 4734 nv_stop_rxtx(dev); 4735 nv_txrx_reset(dev); 4736 /* drain queues */ 4737 nv_drain_rxtx(dev); 4738 /* delete queues */ 4739 free_rings(dev); 4740 } 4741 4742 /* set new values */ 4743 np->rx_ring_size = ring->rx_pending; 4744 np->tx_ring_size = ring->tx_pending; 4745 4746 if (!nv_optimized(np)) { 4747 np->rx_ring.orig = (struct ring_desc *)rxtx_ring; 4748 np->tx_ring.orig = &np->rx_ring.orig[np->rx_ring_size]; 4749 } else { 4750 np->rx_ring.ex = (struct ring_desc_ex *)rxtx_ring; 4751 np->tx_ring.ex = &np->rx_ring.ex[np->rx_ring_size]; 4752 } 4753 np->rx_skb = (struct nv_skb_map *)rx_skbuff; 4754 np->tx_skb = (struct nv_skb_map *)tx_skbuff; 4755 np->ring_addr = ring_addr; 4756 4757 memset(np->rx_skb, 0, sizeof(struct nv_skb_map) * np->rx_ring_size); 4758 memset(np->tx_skb, 0, sizeof(struct nv_skb_map) * np->tx_ring_size); 4759 4760 if (netif_running(dev)) { 4761 /* reinit driver view of the queues */ 4762 set_bufsize(dev); 4763 if (nv_init_ring(dev)) { 4764 if (!np->in_shutdown) 4765 mod_timer(&np->oom_kick, jiffies + OOM_REFILL); 4766 } 4767 4768 /* reinit nic view of the queues */ 4769 writel(np->rx_buf_sz, base + NvRegOffloadConfig); 4770 setup_hw_rings(dev, NV_SETUP_RX_RING | NV_SETUP_TX_RING); 4771 writel(((np->rx_ring_size-1) << NVREG_RINGSZ_RXSHIFT) + ((np->tx_ring_size-1) << NVREG_RINGSZ_TXSHIFT), 4772 base + NvRegRingSizes); 4773 pci_push(base); 4774 writel(NVREG_TXRXCTL_KICK|np->txrxctl_bits, get_hwbase(dev) + NvRegTxRxControl); 4775 pci_push(base); 4776 4777 /* restart engines */ 4778 nv_start_rxtx(dev); 4779 spin_unlock(&np->lock); 4780 netif_addr_unlock(dev); 4781 netif_tx_unlock_bh(dev); 4782 nv_napi_enable(dev); 4783 nv_enable_irq(dev); 4784 } 4785 return 0; 4786 exit: 4787 return -ENOMEM; 4788 } 4789 4790 static void nv_get_pauseparam(struct net_device *dev, struct ethtool_pauseparam* pause) 4791 { 4792 struct fe_priv *np = netdev_priv(dev); 4793 4794 pause->autoneg = (np->pause_flags & NV_PAUSEFRAME_AUTONEG) != 0; 4795 pause->rx_pause = (np->pause_flags & NV_PAUSEFRAME_RX_ENABLE) != 0; 4796 pause->tx_pause = (np->pause_flags & NV_PAUSEFRAME_TX_ENABLE) != 0; 4797 } 4798 4799 static int nv_set_pauseparam(struct net_device *dev, struct ethtool_pauseparam* pause) 4800 { 4801 struct fe_priv *np = netdev_priv(dev); 4802 int adv, bmcr; 4803 4804 if ((!np->autoneg && np->duplex == 0) || 4805 (np->autoneg && !pause->autoneg && np->duplex == 0)) { 4806 netdev_info(dev, "can not set pause settings when forced link is in half duplex\n"); 4807 return -EINVAL; 4808 } 4809 if (pause->tx_pause && !(np->pause_flags & NV_PAUSEFRAME_TX_CAPABLE)) { 4810 netdev_info(dev, "hardware does not support tx pause frames\n"); 4811 return -EINVAL; 4812 } 4813 4814 netif_carrier_off(dev); 4815 if (netif_running(dev)) { 4816 nv_disable_irq(dev); 4817 netif_tx_lock_bh(dev); 4818 netif_addr_lock(dev); 4819 spin_lock(&np->lock); 4820 /* stop engines */ 4821 nv_stop_rxtx(dev); 4822 spin_unlock(&np->lock); 4823 netif_addr_unlock(dev); 4824 netif_tx_unlock_bh(dev); 4825 } 4826 4827 np->pause_flags &= ~(NV_PAUSEFRAME_RX_REQ|NV_PAUSEFRAME_TX_REQ); 4828 if (pause->rx_pause) 4829 np->pause_flags |= NV_PAUSEFRAME_RX_REQ; 4830 if (pause->tx_pause) 4831 np->pause_flags |= NV_PAUSEFRAME_TX_REQ; 4832 4833 if (np->autoneg && pause->autoneg) { 4834 np->pause_flags |= NV_PAUSEFRAME_AUTONEG; 4835 4836 adv = mii_rw(dev, np->phyaddr, MII_ADVERTISE, MII_READ); 4837 adv &= ~(ADVERTISE_PAUSE_CAP | ADVERTISE_PAUSE_ASYM); 4838 if (np->pause_flags & NV_PAUSEFRAME_RX_REQ) /* for rx we set both advertisements but disable tx pause */ 4839 adv |= ADVERTISE_PAUSE_CAP | ADVERTISE_PAUSE_ASYM; 4840 if (np->pause_flags & NV_PAUSEFRAME_TX_REQ) 4841 adv |= ADVERTISE_PAUSE_ASYM; 4842 mii_rw(dev, np->phyaddr, MII_ADVERTISE, adv); 4843 4844 if (netif_running(dev)) 4845 netdev_info(dev, "link down\n"); 4846 bmcr = mii_rw(dev, np->phyaddr, MII_BMCR, MII_READ); 4847 bmcr |= (BMCR_ANENABLE | BMCR_ANRESTART); 4848 mii_rw(dev, np->phyaddr, MII_BMCR, bmcr); 4849 } else { 4850 np->pause_flags &= ~(NV_PAUSEFRAME_AUTONEG|NV_PAUSEFRAME_RX_ENABLE|NV_PAUSEFRAME_TX_ENABLE); 4851 if (pause->rx_pause) 4852 np->pause_flags |= NV_PAUSEFRAME_RX_ENABLE; 4853 if (pause->tx_pause) 4854 np->pause_flags |= NV_PAUSEFRAME_TX_ENABLE; 4855 4856 if (!netif_running(dev)) 4857 nv_update_linkspeed(dev); 4858 else 4859 nv_update_pause(dev, np->pause_flags); 4860 } 4861 4862 if (netif_running(dev)) { 4863 nv_start_rxtx(dev); 4864 nv_enable_irq(dev); 4865 } 4866 return 0; 4867 } 4868 4869 static int nv_set_loopback(struct net_device *dev, netdev_features_t features) 4870 { 4871 struct fe_priv *np = netdev_priv(dev); 4872 unsigned long flags; 4873 u32 miicontrol; 4874 int err, retval = 0; 4875 4876 spin_lock_irqsave(&np->lock, flags); 4877 miicontrol = mii_rw(dev, np->phyaddr, MII_BMCR, MII_READ); 4878 if (features & NETIF_F_LOOPBACK) { 4879 if (miicontrol & BMCR_LOOPBACK) { 4880 spin_unlock_irqrestore(&np->lock, flags); 4881 netdev_info(dev, "Loopback already enabled\n"); 4882 return 0; 4883 } 4884 nv_disable_irq(dev); 4885 /* Turn on loopback mode */ 4886 miicontrol |= BMCR_LOOPBACK | BMCR_FULLDPLX | BMCR_SPEED1000; 4887 err = mii_rw(dev, np->phyaddr, MII_BMCR, miicontrol); 4888 if (err) { 4889 retval = PHY_ERROR; 4890 spin_unlock_irqrestore(&np->lock, flags); 4891 phy_init(dev); 4892 } else { 4893 if (netif_running(dev)) { 4894 /* Force 1000 Mbps full-duplex */ 4895 nv_force_linkspeed(dev, NVREG_LINKSPEED_1000, 4896 1); 4897 /* Force link up */ 4898 netif_carrier_on(dev); 4899 } 4900 spin_unlock_irqrestore(&np->lock, flags); 4901 netdev_info(dev, 4902 "Internal PHY loopback mode enabled.\n"); 4903 } 4904 } else { 4905 if (!(miicontrol & BMCR_LOOPBACK)) { 4906 spin_unlock_irqrestore(&np->lock, flags); 4907 netdev_info(dev, "Loopback already disabled\n"); 4908 return 0; 4909 } 4910 nv_disable_irq(dev); 4911 /* Turn off loopback */ 4912 spin_unlock_irqrestore(&np->lock, flags); 4913 netdev_info(dev, "Internal PHY loopback mode disabled.\n"); 4914 phy_init(dev); 4915 } 4916 msleep(500); 4917 spin_lock_irqsave(&np->lock, flags); 4918 nv_enable_irq(dev); 4919 spin_unlock_irqrestore(&np->lock, flags); 4920 4921 return retval; 4922 } 4923 4924 static netdev_features_t nv_fix_features(struct net_device *dev, 4925 netdev_features_t features) 4926 { 4927 /* vlan is dependent on rx checksum offload */ 4928 if (features & (NETIF_F_HW_VLAN_CTAG_TX|NETIF_F_HW_VLAN_CTAG_RX)) 4929 features |= NETIF_F_RXCSUM; 4930 4931 return features; 4932 } 4933 4934 static void nv_vlan_mode(struct net_device *dev, netdev_features_t features) 4935 { 4936 struct fe_priv *np = get_nvpriv(dev); 4937 4938 spin_lock_irq(&np->lock); 4939 4940 if (features & NETIF_F_HW_VLAN_CTAG_RX) 4941 np->txrxctl_bits |= NVREG_TXRXCTL_VLANSTRIP; 4942 else 4943 np->txrxctl_bits &= ~NVREG_TXRXCTL_VLANSTRIP; 4944 4945 if (features & NETIF_F_HW_VLAN_CTAG_TX) 4946 np->txrxctl_bits |= NVREG_TXRXCTL_VLANINS; 4947 else 4948 np->txrxctl_bits &= ~NVREG_TXRXCTL_VLANINS; 4949 4950 writel(np->txrxctl_bits, get_hwbase(dev) + NvRegTxRxControl); 4951 4952 spin_unlock_irq(&np->lock); 4953 } 4954 4955 static int nv_set_features(struct net_device *dev, netdev_features_t features) 4956 { 4957 struct fe_priv *np = netdev_priv(dev); 4958 u8 __iomem *base = get_hwbase(dev); 4959 netdev_features_t changed = dev->features ^ features; 4960 int retval; 4961 4962 if ((changed & NETIF_F_LOOPBACK) && netif_running(dev)) { 4963 retval = nv_set_loopback(dev, features); 4964 if (retval != 0) 4965 return retval; 4966 } 4967 4968 if (changed & NETIF_F_RXCSUM) { 4969 spin_lock_irq(&np->lock); 4970 4971 if (features & NETIF_F_RXCSUM) 4972 np->txrxctl_bits |= NVREG_TXRXCTL_RXCHECK; 4973 else 4974 np->txrxctl_bits &= ~NVREG_TXRXCTL_RXCHECK; 4975 4976 if (netif_running(dev)) 4977 writel(np->txrxctl_bits, base + NvRegTxRxControl); 4978 4979 spin_unlock_irq(&np->lock); 4980 } 4981 4982 if (changed & (NETIF_F_HW_VLAN_CTAG_TX | NETIF_F_HW_VLAN_CTAG_RX)) 4983 nv_vlan_mode(dev, features); 4984 4985 return 0; 4986 } 4987 4988 static int nv_get_sset_count(struct net_device *dev, int sset) 4989 { 4990 struct fe_priv *np = netdev_priv(dev); 4991 4992 switch (sset) { 4993 case ETH_SS_TEST: 4994 if (np->driver_data & DEV_HAS_TEST_EXTENDED) 4995 return NV_TEST_COUNT_EXTENDED; 4996 else 4997 return NV_TEST_COUNT_BASE; 4998 case ETH_SS_STATS: 4999 if (np->driver_data & DEV_HAS_STATISTICS_V3) 5000 return NV_DEV_STATISTICS_V3_COUNT; 5001 else if (np->driver_data & DEV_HAS_STATISTICS_V2) 5002 return NV_DEV_STATISTICS_V2_COUNT; 5003 else if (np->driver_data & DEV_HAS_STATISTICS_V1) 5004 return NV_DEV_STATISTICS_V1_COUNT; 5005 else 5006 return 0; 5007 default: 5008 return -EOPNOTSUPP; 5009 } 5010 } 5011 5012 static void nv_get_ethtool_stats(struct net_device *dev, 5013 struct ethtool_stats *estats, u64 *buffer) 5014 __acquires(&netdev_priv(dev)->hwstats_lock) 5015 __releases(&netdev_priv(dev)->hwstats_lock) 5016 { 5017 struct fe_priv *np = netdev_priv(dev); 5018 5019 spin_lock_bh(&np->hwstats_lock); 5020 nv_update_stats(dev); 5021 memcpy(buffer, &np->estats, 5022 nv_get_sset_count(dev, ETH_SS_STATS)*sizeof(u64)); 5023 spin_unlock_bh(&np->hwstats_lock); 5024 } 5025 5026 static int nv_link_test(struct net_device *dev) 5027 { 5028 struct fe_priv *np = netdev_priv(dev); 5029 int mii_status; 5030 5031 mii_rw(dev, np->phyaddr, MII_BMSR, MII_READ); 5032 mii_status = mii_rw(dev, np->phyaddr, MII_BMSR, MII_READ); 5033 5034 /* check phy link status */ 5035 if (!(mii_status & BMSR_LSTATUS)) 5036 return 0; 5037 else 5038 return 1; 5039 } 5040 5041 static int nv_register_test(struct net_device *dev) 5042 { 5043 u8 __iomem *base = get_hwbase(dev); 5044 int i = 0; 5045 u32 orig_read, new_read; 5046 5047 do { 5048 orig_read = readl(base + nv_registers_test[i].reg); 5049 5050 /* xor with mask to toggle bits */ 5051 orig_read ^= nv_registers_test[i].mask; 5052 5053 writel(orig_read, base + nv_registers_test[i].reg); 5054 5055 new_read = readl(base + nv_registers_test[i].reg); 5056 5057 if ((new_read & nv_registers_test[i].mask) != (orig_read & nv_registers_test[i].mask)) 5058 return 0; 5059 5060 /* restore original value */ 5061 orig_read ^= nv_registers_test[i].mask; 5062 writel(orig_read, base + nv_registers_test[i].reg); 5063 5064 } while (nv_registers_test[++i].reg != 0); 5065 5066 return 1; 5067 } 5068 5069 static int nv_interrupt_test(struct net_device *dev) 5070 { 5071 struct fe_priv *np = netdev_priv(dev); 5072 u8 __iomem *base = get_hwbase(dev); 5073 int ret = 1; 5074 int testcnt; 5075 u32 save_msi_flags, save_poll_interval = 0; 5076 5077 if (netif_running(dev)) { 5078 /* free current irq */ 5079 nv_free_irq(dev); 5080 save_poll_interval = readl(base+NvRegPollingInterval); 5081 } 5082 5083 /* flag to test interrupt handler */ 5084 np->intr_test = 0; 5085 5086 /* setup test irq */ 5087 save_msi_flags = np->msi_flags; 5088 np->msi_flags &= ~NV_MSI_X_VECTORS_MASK; 5089 np->msi_flags |= 0x001; /* setup 1 vector */ 5090 if (nv_request_irq(dev, 1)) 5091 return 0; 5092 5093 /* setup timer interrupt */ 5094 writel(NVREG_POLL_DEFAULT_CPU, base + NvRegPollingInterval); 5095 writel(NVREG_UNKSETUP6_VAL, base + NvRegUnknownSetupReg6); 5096 5097 nv_enable_hw_interrupts(dev, NVREG_IRQ_TIMER); 5098 5099 /* wait for at least one interrupt */ 5100 msleep(100); 5101 5102 spin_lock_irq(&np->lock); 5103 5104 /* flag should be set within ISR */ 5105 testcnt = np->intr_test; 5106 if (!testcnt) 5107 ret = 2; 5108 5109 nv_disable_hw_interrupts(dev, NVREG_IRQ_TIMER); 5110 if (!(np->msi_flags & NV_MSI_X_ENABLED)) 5111 writel(NVREG_IRQSTAT_MASK, base + NvRegIrqStatus); 5112 else 5113 writel(NVREG_IRQSTAT_MASK, base + NvRegMSIXIrqStatus); 5114 5115 spin_unlock_irq(&np->lock); 5116 5117 nv_free_irq(dev); 5118 5119 np->msi_flags = save_msi_flags; 5120 5121 if (netif_running(dev)) { 5122 writel(save_poll_interval, base + NvRegPollingInterval); 5123 writel(NVREG_UNKSETUP6_VAL, base + NvRegUnknownSetupReg6); 5124 /* restore original irq */ 5125 if (nv_request_irq(dev, 0)) 5126 return 0; 5127 } 5128 5129 return ret; 5130 } 5131 5132 static int nv_loopback_test(struct net_device *dev) 5133 { 5134 struct fe_priv *np = netdev_priv(dev); 5135 u8 __iomem *base = get_hwbase(dev); 5136 struct sk_buff *tx_skb, *rx_skb; 5137 dma_addr_t test_dma_addr; 5138 u32 tx_flags_extra = (np->desc_ver == DESC_VER_1 ? NV_TX_LASTPACKET : NV_TX2_LASTPACKET); 5139 u32 flags; 5140 int len, i, pkt_len; 5141 u8 *pkt_data; 5142 u32 filter_flags = 0; 5143 u32 misc1_flags = 0; 5144 int ret = 1; 5145 5146 if (netif_running(dev)) { 5147 nv_disable_irq(dev); 5148 filter_flags = readl(base + NvRegPacketFilterFlags); 5149 misc1_flags = readl(base + NvRegMisc1); 5150 } else { 5151 nv_txrx_reset(dev); 5152 } 5153 5154 /* reinit driver view of the rx queue */ 5155 set_bufsize(dev); 5156 nv_init_ring(dev); 5157 5158 /* setup hardware for loopback */ 5159 writel(NVREG_MISC1_FORCE, base + NvRegMisc1); 5160 writel(NVREG_PFF_ALWAYS | NVREG_PFF_LOOPBACK, base + NvRegPacketFilterFlags); 5161 5162 /* reinit nic view of the rx queue */ 5163 writel(np->rx_buf_sz, base + NvRegOffloadConfig); 5164 setup_hw_rings(dev, NV_SETUP_RX_RING | NV_SETUP_TX_RING); 5165 writel(((np->rx_ring_size-1) << NVREG_RINGSZ_RXSHIFT) + ((np->tx_ring_size-1) << NVREG_RINGSZ_TXSHIFT), 5166 base + NvRegRingSizes); 5167 pci_push(base); 5168 5169 /* restart rx engine */ 5170 nv_start_rxtx(dev); 5171 5172 /* setup packet for tx */ 5173 pkt_len = ETH_DATA_LEN; 5174 tx_skb = netdev_alloc_skb(dev, pkt_len); 5175 if (!tx_skb) { 5176 ret = 0; 5177 goto out; 5178 } 5179 test_dma_addr = dma_map_single(&np->pci_dev->dev, tx_skb->data, 5180 skb_tailroom(tx_skb), 5181 DMA_FROM_DEVICE); 5182 if (unlikely(dma_mapping_error(&np->pci_dev->dev, 5183 test_dma_addr))) { 5184 dev_kfree_skb_any(tx_skb); 5185 goto out; 5186 } 5187 pkt_data = skb_put(tx_skb, pkt_len); 5188 for (i = 0; i < pkt_len; i++) 5189 pkt_data[i] = (u8)(i & 0xff); 5190 5191 if (!nv_optimized(np)) { 5192 np->tx_ring.orig[0].buf = cpu_to_le32(test_dma_addr); 5193 np->tx_ring.orig[0].flaglen = cpu_to_le32((pkt_len-1) | np->tx_flags | tx_flags_extra); 5194 } else { 5195 np->tx_ring.ex[0].bufhigh = cpu_to_le32(dma_high(test_dma_addr)); 5196 np->tx_ring.ex[0].buflow = cpu_to_le32(dma_low(test_dma_addr)); 5197 np->tx_ring.ex[0].flaglen = cpu_to_le32((pkt_len-1) | np->tx_flags | tx_flags_extra); 5198 } 5199 writel(NVREG_TXRXCTL_KICK|np->txrxctl_bits, get_hwbase(dev) + NvRegTxRxControl); 5200 pci_push(get_hwbase(dev)); 5201 5202 msleep(500); 5203 5204 /* check for rx of the packet */ 5205 if (!nv_optimized(np)) { 5206 flags = le32_to_cpu(np->rx_ring.orig[0].flaglen); 5207 len = nv_descr_getlength(&np->rx_ring.orig[0], np->desc_ver); 5208 5209 } else { 5210 flags = le32_to_cpu(np->rx_ring.ex[0].flaglen); 5211 len = nv_descr_getlength_ex(&np->rx_ring.ex[0], np->desc_ver); 5212 } 5213 5214 if (flags & NV_RX_AVAIL) { 5215 ret = 0; 5216 } else if (np->desc_ver == DESC_VER_1) { 5217 if (flags & NV_RX_ERROR) 5218 ret = 0; 5219 } else { 5220 if (flags & NV_RX2_ERROR) 5221 ret = 0; 5222 } 5223 5224 if (ret) { 5225 if (len != pkt_len) { 5226 ret = 0; 5227 } else { 5228 rx_skb = np->rx_skb[0].skb; 5229 for (i = 0; i < pkt_len; i++) { 5230 if (rx_skb->data[i] != (u8)(i & 0xff)) { 5231 ret = 0; 5232 break; 5233 } 5234 } 5235 } 5236 } 5237 5238 dma_unmap_single(&np->pci_dev->dev, test_dma_addr, 5239 (skb_end_pointer(tx_skb) - tx_skb->data), 5240 DMA_TO_DEVICE); 5241 dev_kfree_skb_any(tx_skb); 5242 out: 5243 /* stop engines */ 5244 nv_stop_rxtx(dev); 5245 nv_txrx_reset(dev); 5246 /* drain rx queue */ 5247 nv_drain_rxtx(dev); 5248 5249 if (netif_running(dev)) { 5250 writel(misc1_flags, base + NvRegMisc1); 5251 writel(filter_flags, base + NvRegPacketFilterFlags); 5252 nv_enable_irq(dev); 5253 } 5254 5255 return ret; 5256 } 5257 5258 static void nv_self_test(struct net_device *dev, struct ethtool_test *test, u64 *buffer) 5259 { 5260 struct fe_priv *np = netdev_priv(dev); 5261 u8 __iomem *base = get_hwbase(dev); 5262 int result, count; 5263 5264 count = nv_get_sset_count(dev, ETH_SS_TEST); 5265 memset(buffer, 0, count * sizeof(u64)); 5266 5267 if (!nv_link_test(dev)) { 5268 test->flags |= ETH_TEST_FL_FAILED; 5269 buffer[0] = 1; 5270 } 5271 5272 if (test->flags & ETH_TEST_FL_OFFLINE) { 5273 if (netif_running(dev)) { 5274 netif_stop_queue(dev); 5275 nv_napi_disable(dev); 5276 netif_tx_lock_bh(dev); 5277 netif_addr_lock(dev); 5278 spin_lock_irq(&np->lock); 5279 nv_disable_hw_interrupts(dev, np->irqmask); 5280 if (!(np->msi_flags & NV_MSI_X_ENABLED)) 5281 writel(NVREG_IRQSTAT_MASK, base + NvRegIrqStatus); 5282 else 5283 writel(NVREG_IRQSTAT_MASK, base + NvRegMSIXIrqStatus); 5284 /* stop engines */ 5285 nv_stop_rxtx(dev); 5286 nv_txrx_reset(dev); 5287 /* drain rx queue */ 5288 nv_drain_rxtx(dev); 5289 spin_unlock_irq(&np->lock); 5290 netif_addr_unlock(dev); 5291 netif_tx_unlock_bh(dev); 5292 } 5293 5294 if (!nv_register_test(dev)) { 5295 test->flags |= ETH_TEST_FL_FAILED; 5296 buffer[1] = 1; 5297 } 5298 5299 result = nv_interrupt_test(dev); 5300 if (result != 1) { 5301 test->flags |= ETH_TEST_FL_FAILED; 5302 buffer[2] = 1; 5303 } 5304 if (result == 0) { 5305 /* bail out */ 5306 return; 5307 } 5308 5309 if (count > NV_TEST_COUNT_BASE && !nv_loopback_test(dev)) { 5310 test->flags |= ETH_TEST_FL_FAILED; 5311 buffer[3] = 1; 5312 } 5313 5314 if (netif_running(dev)) { 5315 /* reinit driver view of the rx queue */ 5316 set_bufsize(dev); 5317 if (nv_init_ring(dev)) { 5318 if (!np->in_shutdown) 5319 mod_timer(&np->oom_kick, jiffies + OOM_REFILL); 5320 } 5321 /* reinit nic view of the rx queue */ 5322 writel(np->rx_buf_sz, base + NvRegOffloadConfig); 5323 setup_hw_rings(dev, NV_SETUP_RX_RING | NV_SETUP_TX_RING); 5324 writel(((np->rx_ring_size-1) << NVREG_RINGSZ_RXSHIFT) + ((np->tx_ring_size-1) << NVREG_RINGSZ_TXSHIFT), 5325 base + NvRegRingSizes); 5326 pci_push(base); 5327 writel(NVREG_TXRXCTL_KICK|np->txrxctl_bits, get_hwbase(dev) + NvRegTxRxControl); 5328 pci_push(base); 5329 /* restart rx engine */ 5330 nv_start_rxtx(dev); 5331 netif_start_queue(dev); 5332 nv_napi_enable(dev); 5333 nv_enable_hw_interrupts(dev, np->irqmask); 5334 } 5335 } 5336 } 5337 5338 static void nv_get_strings(struct net_device *dev, u32 stringset, u8 *buffer) 5339 { 5340 switch (stringset) { 5341 case ETH_SS_STATS: 5342 memcpy(buffer, &nv_estats_str, nv_get_sset_count(dev, ETH_SS_STATS)*sizeof(struct nv_ethtool_str)); 5343 break; 5344 case ETH_SS_TEST: 5345 memcpy(buffer, &nv_etests_str, nv_get_sset_count(dev, ETH_SS_TEST)*sizeof(struct nv_ethtool_str)); 5346 break; 5347 } 5348 } 5349 5350 static const struct ethtool_ops ops = { 5351 .get_drvinfo = nv_get_drvinfo, 5352 .get_link = ethtool_op_get_link, 5353 .get_wol = nv_get_wol, 5354 .set_wol = nv_set_wol, 5355 .get_regs_len = nv_get_regs_len, 5356 .get_regs = nv_get_regs, 5357 .nway_reset = nv_nway_reset, 5358 .get_ringparam = nv_get_ringparam, 5359 .set_ringparam = nv_set_ringparam, 5360 .get_pauseparam = nv_get_pauseparam, 5361 .set_pauseparam = nv_set_pauseparam, 5362 .get_strings = nv_get_strings, 5363 .get_ethtool_stats = nv_get_ethtool_stats, 5364 .get_sset_count = nv_get_sset_count, 5365 .self_test = nv_self_test, 5366 .get_ts_info = ethtool_op_get_ts_info, 5367 .get_link_ksettings = nv_get_link_ksettings, 5368 .set_link_ksettings = nv_set_link_ksettings, 5369 }; 5370 5371 /* The mgmt unit and driver use a semaphore to access the phy during init */ 5372 static int nv_mgmt_acquire_sema(struct net_device *dev) 5373 { 5374 struct fe_priv *np = netdev_priv(dev); 5375 u8 __iomem *base = get_hwbase(dev); 5376 int i; 5377 u32 tx_ctrl, mgmt_sema; 5378 5379 for (i = 0; i < 10; i++) { 5380 mgmt_sema = readl(base + NvRegTransmitterControl) & NVREG_XMITCTL_MGMT_SEMA_MASK; 5381 if (mgmt_sema == NVREG_XMITCTL_MGMT_SEMA_FREE) 5382 break; 5383 msleep(500); 5384 } 5385 5386 if (mgmt_sema != NVREG_XMITCTL_MGMT_SEMA_FREE) 5387 return 0; 5388 5389 for (i = 0; i < 2; i++) { 5390 tx_ctrl = readl(base + NvRegTransmitterControl); 5391 tx_ctrl |= NVREG_XMITCTL_HOST_SEMA_ACQ; 5392 writel(tx_ctrl, base + NvRegTransmitterControl); 5393 5394 /* verify that semaphore was acquired */ 5395 tx_ctrl = readl(base + NvRegTransmitterControl); 5396 if (((tx_ctrl & NVREG_XMITCTL_HOST_SEMA_MASK) == NVREG_XMITCTL_HOST_SEMA_ACQ) && 5397 ((tx_ctrl & NVREG_XMITCTL_MGMT_SEMA_MASK) == NVREG_XMITCTL_MGMT_SEMA_FREE)) { 5398 np->mgmt_sema = 1; 5399 return 1; 5400 } else 5401 udelay(50); 5402 } 5403 5404 return 0; 5405 } 5406 5407 static void nv_mgmt_release_sema(struct net_device *dev) 5408 { 5409 struct fe_priv *np = netdev_priv(dev); 5410 u8 __iomem *base = get_hwbase(dev); 5411 u32 tx_ctrl; 5412 5413 if (np->driver_data & DEV_HAS_MGMT_UNIT) { 5414 if (np->mgmt_sema) { 5415 tx_ctrl = readl(base + NvRegTransmitterControl); 5416 tx_ctrl &= ~NVREG_XMITCTL_HOST_SEMA_ACQ; 5417 writel(tx_ctrl, base + NvRegTransmitterControl); 5418 } 5419 } 5420 } 5421 5422 5423 static int nv_mgmt_get_version(struct net_device *dev) 5424 { 5425 struct fe_priv *np = netdev_priv(dev); 5426 u8 __iomem *base = get_hwbase(dev); 5427 u32 data_ready = readl(base + NvRegTransmitterControl); 5428 u32 data_ready2 = 0; 5429 unsigned long start; 5430 int ready = 0; 5431 5432 writel(NVREG_MGMTUNITGETVERSION, base + NvRegMgmtUnitGetVersion); 5433 writel(data_ready ^ NVREG_XMITCTL_DATA_START, base + NvRegTransmitterControl); 5434 start = jiffies; 5435 while (time_before(jiffies, start + 5*HZ)) { 5436 data_ready2 = readl(base + NvRegTransmitterControl); 5437 if ((data_ready & NVREG_XMITCTL_DATA_READY) != (data_ready2 & NVREG_XMITCTL_DATA_READY)) { 5438 ready = 1; 5439 break; 5440 } 5441 schedule_timeout_uninterruptible(1); 5442 } 5443 5444 if (!ready || (data_ready2 & NVREG_XMITCTL_DATA_ERROR)) 5445 return 0; 5446 5447 np->mgmt_version = readl(base + NvRegMgmtUnitVersion) & NVREG_MGMTUNITVERSION; 5448 5449 return 1; 5450 } 5451 5452 static int nv_open(struct net_device *dev) 5453 { 5454 struct fe_priv *np = netdev_priv(dev); 5455 u8 __iomem *base = get_hwbase(dev); 5456 int ret = 1; 5457 int oom, i; 5458 u32 low; 5459 5460 /* power up phy */ 5461 mii_rw(dev, np->phyaddr, MII_BMCR, 5462 mii_rw(dev, np->phyaddr, MII_BMCR, MII_READ) & ~BMCR_PDOWN); 5463 5464 nv_txrx_gate(dev, false); 5465 /* erase previous misconfiguration */ 5466 if (np->driver_data & DEV_HAS_POWER_CNTRL) 5467 nv_mac_reset(dev); 5468 writel(NVREG_MCASTADDRA_FORCE, base + NvRegMulticastAddrA); 5469 writel(0, base + NvRegMulticastAddrB); 5470 writel(NVREG_MCASTMASKA_NONE, base + NvRegMulticastMaskA); 5471 writel(NVREG_MCASTMASKB_NONE, base + NvRegMulticastMaskB); 5472 writel(0, base + NvRegPacketFilterFlags); 5473 5474 writel(0, base + NvRegTransmitterControl); 5475 writel(0, base + NvRegReceiverControl); 5476 5477 writel(0, base + NvRegAdapterControl); 5478 5479 if (np->pause_flags & NV_PAUSEFRAME_TX_CAPABLE) 5480 writel(NVREG_TX_PAUSEFRAME_DISABLE, base + NvRegTxPauseFrame); 5481 5482 /* initialize descriptor rings */ 5483 set_bufsize(dev); 5484 oom = nv_init_ring(dev); 5485 5486 writel(0, base + NvRegLinkSpeed); 5487 writel(readl(base + NvRegTransmitPoll) & NVREG_TRANSMITPOLL_MAC_ADDR_REV, base + NvRegTransmitPoll); 5488 nv_txrx_reset(dev); 5489 writel(0, base + NvRegUnknownSetupReg6); 5490 5491 np->in_shutdown = 0; 5492 5493 /* give hw rings */ 5494 setup_hw_rings(dev, NV_SETUP_RX_RING | NV_SETUP_TX_RING); 5495 writel(((np->rx_ring_size-1) << NVREG_RINGSZ_RXSHIFT) + ((np->tx_ring_size-1) << NVREG_RINGSZ_TXSHIFT), 5496 base + NvRegRingSizes); 5497 5498 writel(np->linkspeed, base + NvRegLinkSpeed); 5499 if (np->desc_ver == DESC_VER_1) 5500 writel(NVREG_TX_WM_DESC1_DEFAULT, base + NvRegTxWatermark); 5501 else 5502 writel(NVREG_TX_WM_DESC2_3_DEFAULT, base + NvRegTxWatermark); 5503 writel(np->txrxctl_bits, base + NvRegTxRxControl); 5504 writel(np->vlanctl_bits, base + NvRegVlanControl); 5505 pci_push(base); 5506 writel(NVREG_TXRXCTL_BIT1|np->txrxctl_bits, base + NvRegTxRxControl); 5507 if (reg_delay(dev, NvRegUnknownSetupReg5, 5508 NVREG_UNKSETUP5_BIT31, NVREG_UNKSETUP5_BIT31, 5509 NV_SETUP5_DELAY, NV_SETUP5_DELAYMAX)) 5510 netdev_info(dev, 5511 "%s: SetupReg5, Bit 31 remained off\n", __func__); 5512 5513 writel(0, base + NvRegMIIMask); 5514 writel(NVREG_IRQSTAT_MASK, base + NvRegIrqStatus); 5515 writel(NVREG_MIISTAT_MASK_ALL, base + NvRegMIIStatus); 5516 5517 writel(NVREG_MISC1_FORCE | NVREG_MISC1_HD, base + NvRegMisc1); 5518 writel(readl(base + NvRegTransmitterStatus), base + NvRegTransmitterStatus); 5519 writel(NVREG_PFF_ALWAYS, base + NvRegPacketFilterFlags); 5520 writel(np->rx_buf_sz, base + NvRegOffloadConfig); 5521 5522 writel(readl(base + NvRegReceiverStatus), base + NvRegReceiverStatus); 5523 5524 get_random_bytes(&low, sizeof(low)); 5525 low &= NVREG_SLOTTIME_MASK; 5526 if (np->desc_ver == DESC_VER_1) { 5527 writel(low|NVREG_SLOTTIME_DEFAULT, base + NvRegSlotTime); 5528 } else { 5529 if (!(np->driver_data & DEV_HAS_GEAR_MODE)) { 5530 /* setup legacy backoff */ 5531 writel(NVREG_SLOTTIME_LEGBF_ENABLED|NVREG_SLOTTIME_10_100_FULL|low, base + NvRegSlotTime); 5532 } else { 5533 writel(NVREG_SLOTTIME_10_100_FULL, base + NvRegSlotTime); 5534 nv_gear_backoff_reseed(dev); 5535 } 5536 } 5537 writel(NVREG_TX_DEFERRAL_DEFAULT, base + NvRegTxDeferral); 5538 writel(NVREG_RX_DEFERRAL_DEFAULT, base + NvRegRxDeferral); 5539 if (poll_interval == -1) { 5540 if (optimization_mode == NV_OPTIMIZATION_MODE_THROUGHPUT) 5541 writel(NVREG_POLL_DEFAULT_THROUGHPUT, base + NvRegPollingInterval); 5542 else 5543 writel(NVREG_POLL_DEFAULT_CPU, base + NvRegPollingInterval); 5544 } else 5545 writel(poll_interval & 0xFFFF, base + NvRegPollingInterval); 5546 writel(NVREG_UNKSETUP6_VAL, base + NvRegUnknownSetupReg6); 5547 writel((np->phyaddr << NVREG_ADAPTCTL_PHYSHIFT)|NVREG_ADAPTCTL_PHYVALID|NVREG_ADAPTCTL_RUNNING, 5548 base + NvRegAdapterControl); 5549 writel(NVREG_MIISPEED_BIT8|NVREG_MIIDELAY, base + NvRegMIISpeed); 5550 writel(NVREG_MII_LINKCHANGE, base + NvRegMIIMask); 5551 if (np->wolenabled) 5552 writel(NVREG_WAKEUPFLAGS_ENABLE , base + NvRegWakeUpFlags); 5553 5554 i = readl(base + NvRegPowerState); 5555 if ((i & NVREG_POWERSTATE_POWEREDUP) == 0) 5556 writel(NVREG_POWERSTATE_POWEREDUP|i, base + NvRegPowerState); 5557 5558 pci_push(base); 5559 udelay(10); 5560 writel(readl(base + NvRegPowerState) | NVREG_POWERSTATE_VALID, base + NvRegPowerState); 5561 5562 nv_disable_hw_interrupts(dev, np->irqmask); 5563 pci_push(base); 5564 writel(NVREG_MIISTAT_MASK_ALL, base + NvRegMIIStatus); 5565 writel(NVREG_IRQSTAT_MASK, base + NvRegIrqStatus); 5566 pci_push(base); 5567 5568 if (nv_request_irq(dev, 0)) 5569 goto out_drain; 5570 5571 /* ask for interrupts */ 5572 nv_enable_hw_interrupts(dev, np->irqmask); 5573 5574 spin_lock_irq(&np->lock); 5575 writel(NVREG_MCASTADDRA_FORCE, base + NvRegMulticastAddrA); 5576 writel(0, base + NvRegMulticastAddrB); 5577 writel(NVREG_MCASTMASKA_NONE, base + NvRegMulticastMaskA); 5578 writel(NVREG_MCASTMASKB_NONE, base + NvRegMulticastMaskB); 5579 writel(NVREG_PFF_ALWAYS|NVREG_PFF_MYADDR, base + NvRegPacketFilterFlags); 5580 /* One manual link speed update: Interrupts are enabled, future link 5581 * speed changes cause interrupts and are handled by nv_link_irq(). 5582 */ 5583 readl(base + NvRegMIIStatus); 5584 writel(NVREG_MIISTAT_MASK_ALL, base + NvRegMIIStatus); 5585 5586 /* set linkspeed to invalid value, thus force nv_update_linkspeed 5587 * to init hw */ 5588 np->linkspeed = 0; 5589 ret = nv_update_linkspeed(dev); 5590 nv_start_rxtx(dev); 5591 netif_start_queue(dev); 5592 nv_napi_enable(dev); 5593 5594 if (ret) { 5595 netif_carrier_on(dev); 5596 } else { 5597 netdev_info(dev, "no link during initialization\n"); 5598 netif_carrier_off(dev); 5599 } 5600 if (oom) 5601 mod_timer(&np->oom_kick, jiffies + OOM_REFILL); 5602 5603 /* start statistics timer */ 5604 if (np->driver_data & (DEV_HAS_STATISTICS_V1|DEV_HAS_STATISTICS_V2|DEV_HAS_STATISTICS_V3)) 5605 mod_timer(&np->stats_poll, 5606 round_jiffies(jiffies + STATS_INTERVAL)); 5607 5608 spin_unlock_irq(&np->lock); 5609 5610 /* If the loopback feature was set while the device was down, make sure 5611 * that it's set correctly now. 5612 */ 5613 if (dev->features & NETIF_F_LOOPBACK) 5614 nv_set_loopback(dev, dev->features); 5615 5616 return 0; 5617 out_drain: 5618 nv_drain_rxtx(dev); 5619 return ret; 5620 } 5621 5622 static int nv_close(struct net_device *dev) 5623 { 5624 struct fe_priv *np = netdev_priv(dev); 5625 u8 __iomem *base; 5626 5627 spin_lock_irq(&np->lock); 5628 np->in_shutdown = 1; 5629 spin_unlock_irq(&np->lock); 5630 nv_napi_disable(dev); 5631 synchronize_irq(np->pci_dev->irq); 5632 5633 del_timer_sync(&np->oom_kick); 5634 del_timer_sync(&np->nic_poll); 5635 del_timer_sync(&np->stats_poll); 5636 5637 netif_stop_queue(dev); 5638 spin_lock_irq(&np->lock); 5639 nv_update_pause(dev, 0); /* otherwise stop_tx bricks NIC */ 5640 nv_stop_rxtx(dev); 5641 nv_txrx_reset(dev); 5642 5643 /* disable interrupts on the nic or we will lock up */ 5644 base = get_hwbase(dev); 5645 nv_disable_hw_interrupts(dev, np->irqmask); 5646 pci_push(base); 5647 5648 spin_unlock_irq(&np->lock); 5649 5650 nv_free_irq(dev); 5651 5652 nv_drain_rxtx(dev); 5653 5654 if (np->wolenabled || !phy_power_down) { 5655 nv_txrx_gate(dev, false); 5656 writel(NVREG_PFF_ALWAYS|NVREG_PFF_MYADDR, base + NvRegPacketFilterFlags); 5657 nv_start_rx(dev); 5658 } else { 5659 /* power down phy */ 5660 mii_rw(dev, np->phyaddr, MII_BMCR, 5661 mii_rw(dev, np->phyaddr, MII_BMCR, MII_READ)|BMCR_PDOWN); 5662 nv_txrx_gate(dev, true); 5663 } 5664 5665 /* FIXME: power down nic */ 5666 5667 return 0; 5668 } 5669 5670 static const struct net_device_ops nv_netdev_ops = { 5671 .ndo_open = nv_open, 5672 .ndo_stop = nv_close, 5673 .ndo_get_stats64 = nv_get_stats64, 5674 .ndo_start_xmit = nv_start_xmit, 5675 .ndo_tx_timeout = nv_tx_timeout, 5676 .ndo_change_mtu = nv_change_mtu, 5677 .ndo_fix_features = nv_fix_features, 5678 .ndo_set_features = nv_set_features, 5679 .ndo_validate_addr = eth_validate_addr, 5680 .ndo_set_mac_address = nv_set_mac_address, 5681 .ndo_set_rx_mode = nv_set_multicast, 5682 #ifdef CONFIG_NET_POLL_CONTROLLER 5683 .ndo_poll_controller = nv_poll_controller, 5684 #endif 5685 }; 5686 5687 static const struct net_device_ops nv_netdev_ops_optimized = { 5688 .ndo_open = nv_open, 5689 .ndo_stop = nv_close, 5690 .ndo_get_stats64 = nv_get_stats64, 5691 .ndo_start_xmit = nv_start_xmit_optimized, 5692 .ndo_tx_timeout = nv_tx_timeout, 5693 .ndo_change_mtu = nv_change_mtu, 5694 .ndo_fix_features = nv_fix_features, 5695 .ndo_set_features = nv_set_features, 5696 .ndo_validate_addr = eth_validate_addr, 5697 .ndo_set_mac_address = nv_set_mac_address, 5698 .ndo_set_rx_mode = nv_set_multicast, 5699 #ifdef CONFIG_NET_POLL_CONTROLLER 5700 .ndo_poll_controller = nv_poll_controller, 5701 #endif 5702 }; 5703 5704 static int nv_probe(struct pci_dev *pci_dev, const struct pci_device_id *id) 5705 { 5706 struct net_device *dev; 5707 struct fe_priv *np; 5708 unsigned long addr; 5709 u8 __iomem *base; 5710 int err, i; 5711 u32 powerstate, txreg; 5712 u32 phystate_orig = 0, phystate; 5713 int phyinitialized = 0; 5714 static int printed_version; 5715 5716 if (!printed_version++) 5717 pr_info("Reverse Engineered nForce ethernet driver. Version %s.\n", 5718 FORCEDETH_VERSION); 5719 5720 dev = alloc_etherdev(sizeof(struct fe_priv)); 5721 err = -ENOMEM; 5722 if (!dev) 5723 goto out; 5724 5725 np = netdev_priv(dev); 5726 np->dev = dev; 5727 np->pci_dev = pci_dev; 5728 spin_lock_init(&np->lock); 5729 spin_lock_init(&np->hwstats_lock); 5730 SET_NETDEV_DEV(dev, &pci_dev->dev); 5731 u64_stats_init(&np->swstats_rx_syncp); 5732 u64_stats_init(&np->swstats_tx_syncp); 5733 np->txrx_stats = alloc_percpu(struct nv_txrx_stats); 5734 if (!np->txrx_stats) { 5735 pr_err("np->txrx_stats, alloc memory error.\n"); 5736 err = -ENOMEM; 5737 goto out_alloc_percpu; 5738 } 5739 5740 timer_setup(&np->oom_kick, nv_do_rx_refill, 0); 5741 timer_setup(&np->nic_poll, nv_do_nic_poll, 0); 5742 timer_setup(&np->stats_poll, nv_do_stats_poll, TIMER_DEFERRABLE); 5743 5744 err = pci_enable_device(pci_dev); 5745 if (err) 5746 goto out_free; 5747 5748 pci_set_master(pci_dev); 5749 5750 err = pci_request_regions(pci_dev, DRV_NAME); 5751 if (err < 0) 5752 goto out_disable; 5753 5754 if (id->driver_data & (DEV_HAS_VLAN|DEV_HAS_MSI_X|DEV_HAS_POWER_CNTRL|DEV_HAS_STATISTICS_V2|DEV_HAS_STATISTICS_V3)) 5755 np->register_size = NV_PCI_REGSZ_VER3; 5756 else if (id->driver_data & DEV_HAS_STATISTICS_V1) 5757 np->register_size = NV_PCI_REGSZ_VER2; 5758 else 5759 np->register_size = NV_PCI_REGSZ_VER1; 5760 5761 err = -EINVAL; 5762 addr = 0; 5763 for (i = 0; i < DEVICE_COUNT_RESOURCE; i++) { 5764 if (pci_resource_flags(pci_dev, i) & IORESOURCE_MEM && 5765 pci_resource_len(pci_dev, i) >= np->register_size) { 5766 addr = pci_resource_start(pci_dev, i); 5767 break; 5768 } 5769 } 5770 if (i == DEVICE_COUNT_RESOURCE) { 5771 dev_info(&pci_dev->dev, "Couldn't find register window\n"); 5772 goto out_relreg; 5773 } 5774 5775 /* copy of driver data */ 5776 np->driver_data = id->driver_data; 5777 /* copy of device id */ 5778 np->device_id = id->device; 5779 5780 /* handle different descriptor versions */ 5781 if (id->driver_data & DEV_HAS_HIGH_DMA) { 5782 /* packet format 3: supports 40-bit addressing */ 5783 np->desc_ver = DESC_VER_3; 5784 np->txrxctl_bits = NVREG_TXRXCTL_DESC_3; 5785 if (dma_64bit) { 5786 if (pci_set_dma_mask(pci_dev, DMA_BIT_MASK(39))) 5787 dev_info(&pci_dev->dev, 5788 "64-bit DMA failed, using 32-bit addressing\n"); 5789 else 5790 dev->features |= NETIF_F_HIGHDMA; 5791 if (pci_set_consistent_dma_mask(pci_dev, DMA_BIT_MASK(39))) { 5792 dev_info(&pci_dev->dev, 5793 "64-bit DMA (consistent) failed, using 32-bit ring buffers\n"); 5794 } 5795 } 5796 } else if (id->driver_data & DEV_HAS_LARGEDESC) { 5797 /* packet format 2: supports jumbo frames */ 5798 np->desc_ver = DESC_VER_2; 5799 np->txrxctl_bits = NVREG_TXRXCTL_DESC_2; 5800 } else { 5801 /* original packet format */ 5802 np->desc_ver = DESC_VER_1; 5803 np->txrxctl_bits = NVREG_TXRXCTL_DESC_1; 5804 } 5805 5806 np->pkt_limit = NV_PKTLIMIT_1; 5807 if (id->driver_data & DEV_HAS_LARGEDESC) 5808 np->pkt_limit = NV_PKTLIMIT_2; 5809 5810 if (id->driver_data & DEV_HAS_CHECKSUM) { 5811 np->txrxctl_bits |= NVREG_TXRXCTL_RXCHECK; 5812 dev->hw_features |= NETIF_F_IP_CSUM | NETIF_F_SG | 5813 NETIF_F_TSO | NETIF_F_RXCSUM; 5814 } 5815 5816 np->vlanctl_bits = 0; 5817 if (id->driver_data & DEV_HAS_VLAN) { 5818 np->vlanctl_bits = NVREG_VLANCONTROL_ENABLE; 5819 dev->hw_features |= NETIF_F_HW_VLAN_CTAG_RX | 5820 NETIF_F_HW_VLAN_CTAG_TX; 5821 } 5822 5823 dev->features |= dev->hw_features; 5824 5825 /* Add loopback capability to the device. */ 5826 dev->hw_features |= NETIF_F_LOOPBACK; 5827 5828 /* MTU range: 64 - 1500 or 9100 */ 5829 dev->min_mtu = ETH_ZLEN + ETH_FCS_LEN; 5830 dev->max_mtu = np->pkt_limit; 5831 5832 np->pause_flags = NV_PAUSEFRAME_RX_CAPABLE | NV_PAUSEFRAME_RX_REQ | NV_PAUSEFRAME_AUTONEG; 5833 if ((id->driver_data & DEV_HAS_PAUSEFRAME_TX_V1) || 5834 (id->driver_data & DEV_HAS_PAUSEFRAME_TX_V2) || 5835 (id->driver_data & DEV_HAS_PAUSEFRAME_TX_V3)) { 5836 np->pause_flags |= NV_PAUSEFRAME_TX_CAPABLE | NV_PAUSEFRAME_TX_REQ; 5837 } 5838 5839 err = -ENOMEM; 5840 np->base = ioremap(addr, np->register_size); 5841 if (!np->base) 5842 goto out_relreg; 5843 5844 np->rx_ring_size = RX_RING_DEFAULT; 5845 np->tx_ring_size = TX_RING_DEFAULT; 5846 5847 if (!nv_optimized(np)) { 5848 np->rx_ring.orig = dma_alloc_coherent(&pci_dev->dev, 5849 sizeof(struct ring_desc) * 5850 (np->rx_ring_size + 5851 np->tx_ring_size), 5852 &np->ring_addr, 5853 GFP_KERNEL); 5854 if (!np->rx_ring.orig) 5855 goto out_unmap; 5856 np->tx_ring.orig = &np->rx_ring.orig[np->rx_ring_size]; 5857 } else { 5858 np->rx_ring.ex = dma_alloc_coherent(&pci_dev->dev, 5859 sizeof(struct ring_desc_ex) * 5860 (np->rx_ring_size + 5861 np->tx_ring_size), 5862 &np->ring_addr, GFP_KERNEL); 5863 if (!np->rx_ring.ex) 5864 goto out_unmap; 5865 np->tx_ring.ex = &np->rx_ring.ex[np->rx_ring_size]; 5866 } 5867 np->rx_skb = kcalloc(np->rx_ring_size, sizeof(struct nv_skb_map), GFP_KERNEL); 5868 np->tx_skb = kcalloc(np->tx_ring_size, sizeof(struct nv_skb_map), GFP_KERNEL); 5869 if (!np->rx_skb || !np->tx_skb) 5870 goto out_freering; 5871 5872 if (!nv_optimized(np)) 5873 dev->netdev_ops = &nv_netdev_ops; 5874 else 5875 dev->netdev_ops = &nv_netdev_ops_optimized; 5876 5877 netif_napi_add(dev, &np->napi, nv_napi_poll, RX_WORK_PER_LOOP); 5878 dev->ethtool_ops = &ops; 5879 dev->watchdog_timeo = NV_WATCHDOG_TIMEO; 5880 5881 pci_set_drvdata(pci_dev, dev); 5882 5883 /* read the mac address */ 5884 base = get_hwbase(dev); 5885 np->orig_mac[0] = readl(base + NvRegMacAddrA); 5886 np->orig_mac[1] = readl(base + NvRegMacAddrB); 5887 5888 /* check the workaround bit for correct mac address order */ 5889 txreg = readl(base + NvRegTransmitPoll); 5890 if (id->driver_data & DEV_HAS_CORRECT_MACADDR) { 5891 /* mac address is already in correct order */ 5892 dev->dev_addr[0] = (np->orig_mac[0] >> 0) & 0xff; 5893 dev->dev_addr[1] = (np->orig_mac[0] >> 8) & 0xff; 5894 dev->dev_addr[2] = (np->orig_mac[0] >> 16) & 0xff; 5895 dev->dev_addr[3] = (np->orig_mac[0] >> 24) & 0xff; 5896 dev->dev_addr[4] = (np->orig_mac[1] >> 0) & 0xff; 5897 dev->dev_addr[5] = (np->orig_mac[1] >> 8) & 0xff; 5898 } else if (txreg & NVREG_TRANSMITPOLL_MAC_ADDR_REV) { 5899 /* mac address is already in correct order */ 5900 dev->dev_addr[0] = (np->orig_mac[0] >> 0) & 0xff; 5901 dev->dev_addr[1] = (np->orig_mac[0] >> 8) & 0xff; 5902 dev->dev_addr[2] = (np->orig_mac[0] >> 16) & 0xff; 5903 dev->dev_addr[3] = (np->orig_mac[0] >> 24) & 0xff; 5904 dev->dev_addr[4] = (np->orig_mac[1] >> 0) & 0xff; 5905 dev->dev_addr[5] = (np->orig_mac[1] >> 8) & 0xff; 5906 /* 5907 * Set orig mac address back to the reversed version. 5908 * This flag will be cleared during low power transition. 5909 * Therefore, we should always put back the reversed address. 5910 */ 5911 np->orig_mac[0] = (dev->dev_addr[5] << 0) + (dev->dev_addr[4] << 8) + 5912 (dev->dev_addr[3] << 16) + (dev->dev_addr[2] << 24); 5913 np->orig_mac[1] = (dev->dev_addr[1] << 0) + (dev->dev_addr[0] << 8); 5914 } else { 5915 /* need to reverse mac address to correct order */ 5916 dev->dev_addr[0] = (np->orig_mac[1] >> 8) & 0xff; 5917 dev->dev_addr[1] = (np->orig_mac[1] >> 0) & 0xff; 5918 dev->dev_addr[2] = (np->orig_mac[0] >> 24) & 0xff; 5919 dev->dev_addr[3] = (np->orig_mac[0] >> 16) & 0xff; 5920 dev->dev_addr[4] = (np->orig_mac[0] >> 8) & 0xff; 5921 dev->dev_addr[5] = (np->orig_mac[0] >> 0) & 0xff; 5922 writel(txreg|NVREG_TRANSMITPOLL_MAC_ADDR_REV, base + NvRegTransmitPoll); 5923 dev_dbg(&pci_dev->dev, 5924 "%s: set workaround bit for reversed mac addr\n", 5925 __func__); 5926 } 5927 5928 if (!is_valid_ether_addr(dev->dev_addr)) { 5929 /* 5930 * Bad mac address. At least one bios sets the mac address 5931 * to 01:23:45:67:89:ab 5932 */ 5933 dev_err(&pci_dev->dev, 5934 "Invalid MAC address detected: %pM - Please complain to your hardware vendor.\n", 5935 dev->dev_addr); 5936 eth_hw_addr_random(dev); 5937 dev_err(&pci_dev->dev, 5938 "Using random MAC address: %pM\n", dev->dev_addr); 5939 } 5940 5941 /* set mac address */ 5942 nv_copy_mac_to_hw(dev); 5943 5944 /* disable WOL */ 5945 writel(0, base + NvRegWakeUpFlags); 5946 np->wolenabled = 0; 5947 device_set_wakeup_enable(&pci_dev->dev, false); 5948 5949 if (id->driver_data & DEV_HAS_POWER_CNTRL) { 5950 5951 /* take phy and nic out of low power mode */ 5952 powerstate = readl(base + NvRegPowerState2); 5953 powerstate &= ~NVREG_POWERSTATE2_POWERUP_MASK; 5954 if ((id->driver_data & DEV_NEED_LOW_POWER_FIX) && 5955 pci_dev->revision >= 0xA3) 5956 powerstate |= NVREG_POWERSTATE2_POWERUP_REV_A3; 5957 writel(powerstate, base + NvRegPowerState2); 5958 } 5959 5960 if (np->desc_ver == DESC_VER_1) 5961 np->tx_flags = NV_TX_VALID; 5962 else 5963 np->tx_flags = NV_TX2_VALID; 5964 5965 np->msi_flags = 0; 5966 if ((id->driver_data & DEV_HAS_MSI) && msi) 5967 np->msi_flags |= NV_MSI_CAPABLE; 5968 5969 if ((id->driver_data & DEV_HAS_MSI_X) && msix) { 5970 /* msix has had reported issues when modifying irqmask 5971 as in the case of napi, therefore, disable for now 5972 */ 5973 #if 0 5974 np->msi_flags |= NV_MSI_X_CAPABLE; 5975 #endif 5976 } 5977 5978 if (optimization_mode == NV_OPTIMIZATION_MODE_CPU) { 5979 np->irqmask = NVREG_IRQMASK_CPU; 5980 if (np->msi_flags & NV_MSI_X_CAPABLE) /* set number of vectors */ 5981 np->msi_flags |= 0x0001; 5982 } else if (optimization_mode == NV_OPTIMIZATION_MODE_DYNAMIC && 5983 !(id->driver_data & DEV_NEED_TIMERIRQ)) { 5984 /* start off in throughput mode */ 5985 np->irqmask = NVREG_IRQMASK_THROUGHPUT; 5986 /* remove support for msix mode */ 5987 np->msi_flags &= ~NV_MSI_X_CAPABLE; 5988 } else { 5989 optimization_mode = NV_OPTIMIZATION_MODE_THROUGHPUT; 5990 np->irqmask = NVREG_IRQMASK_THROUGHPUT; 5991 if (np->msi_flags & NV_MSI_X_CAPABLE) /* set number of vectors */ 5992 np->msi_flags |= 0x0003; 5993 } 5994 5995 if (id->driver_data & DEV_NEED_TIMERIRQ) 5996 np->irqmask |= NVREG_IRQ_TIMER; 5997 if (id->driver_data & DEV_NEED_LINKTIMER) { 5998 np->need_linktimer = 1; 5999 np->link_timeout = jiffies + LINK_TIMEOUT; 6000 } else { 6001 np->need_linktimer = 0; 6002 } 6003 6004 /* Limit the number of tx's outstanding for hw bug */ 6005 if (id->driver_data & DEV_NEED_TX_LIMIT) { 6006 np->tx_limit = 1; 6007 if (((id->driver_data & DEV_NEED_TX_LIMIT2) == DEV_NEED_TX_LIMIT2) && 6008 pci_dev->revision >= 0xA2) 6009 np->tx_limit = 0; 6010 } 6011 6012 /* clear phy state and temporarily halt phy interrupts */ 6013 writel(0, base + NvRegMIIMask); 6014 phystate = readl(base + NvRegAdapterControl); 6015 if (phystate & NVREG_ADAPTCTL_RUNNING) { 6016 phystate_orig = 1; 6017 phystate &= ~NVREG_ADAPTCTL_RUNNING; 6018 writel(phystate, base + NvRegAdapterControl); 6019 } 6020 writel(NVREG_MIISTAT_MASK_ALL, base + NvRegMIIStatus); 6021 6022 if (id->driver_data & DEV_HAS_MGMT_UNIT) { 6023 /* management unit running on the mac? */ 6024 if ((readl(base + NvRegTransmitterControl) & NVREG_XMITCTL_MGMT_ST) && 6025 (readl(base + NvRegTransmitterControl) & NVREG_XMITCTL_SYNC_PHY_INIT) && 6026 nv_mgmt_acquire_sema(dev) && 6027 nv_mgmt_get_version(dev)) { 6028 np->mac_in_use = 1; 6029 if (np->mgmt_version > 0) 6030 np->mac_in_use = readl(base + NvRegMgmtUnitControl) & NVREG_MGMTUNITCONTROL_INUSE; 6031 /* management unit setup the phy already? */ 6032 if (np->mac_in_use && 6033 ((readl(base + NvRegTransmitterControl) & NVREG_XMITCTL_SYNC_MASK) == 6034 NVREG_XMITCTL_SYNC_PHY_INIT)) { 6035 /* phy is inited by mgmt unit */ 6036 phyinitialized = 1; 6037 } else { 6038 /* we need to init the phy */ 6039 } 6040 } 6041 } 6042 6043 /* find a suitable phy */ 6044 for (i = 1; i <= 32; i++) { 6045 int id1, id2; 6046 int phyaddr = i & 0x1F; 6047 6048 spin_lock_irq(&np->lock); 6049 id1 = mii_rw(dev, phyaddr, MII_PHYSID1, MII_READ); 6050 spin_unlock_irq(&np->lock); 6051 if (id1 < 0 || id1 == 0xffff) 6052 continue; 6053 spin_lock_irq(&np->lock); 6054 id2 = mii_rw(dev, phyaddr, MII_PHYSID2, MII_READ); 6055 spin_unlock_irq(&np->lock); 6056 if (id2 < 0 || id2 == 0xffff) 6057 continue; 6058 6059 np->phy_model = id2 & PHYID2_MODEL_MASK; 6060 id1 = (id1 & PHYID1_OUI_MASK) << PHYID1_OUI_SHFT; 6061 id2 = (id2 & PHYID2_OUI_MASK) >> PHYID2_OUI_SHFT; 6062 np->phyaddr = phyaddr; 6063 np->phy_oui = id1 | id2; 6064 6065 /* Realtek hardcoded phy id1 to all zero's on certain phys */ 6066 if (np->phy_oui == PHY_OUI_REALTEK2) 6067 np->phy_oui = PHY_OUI_REALTEK; 6068 /* Setup phy revision for Realtek */ 6069 if (np->phy_oui == PHY_OUI_REALTEK && np->phy_model == PHY_MODEL_REALTEK_8211) 6070 np->phy_rev = mii_rw(dev, phyaddr, MII_RESV1, MII_READ) & PHY_REV_MASK; 6071 6072 break; 6073 } 6074 if (i == 33) { 6075 dev_info(&pci_dev->dev, "open: Could not find a valid PHY\n"); 6076 goto out_error; 6077 } 6078 6079 if (!phyinitialized) { 6080 /* reset it */ 6081 phy_init(dev); 6082 } else { 6083 /* see if it is a gigabit phy */ 6084 u32 mii_status = mii_rw(dev, np->phyaddr, MII_BMSR, MII_READ); 6085 if (mii_status & PHY_GIGABIT) 6086 np->gigabit = PHY_GIGABIT; 6087 } 6088 6089 /* set default link speed settings */ 6090 np->linkspeed = NVREG_LINKSPEED_FORCE|NVREG_LINKSPEED_10; 6091 np->duplex = 0; 6092 np->autoneg = 1; 6093 6094 err = register_netdev(dev); 6095 if (err) { 6096 dev_info(&pci_dev->dev, "unable to register netdev: %d\n", err); 6097 goto out_error; 6098 } 6099 6100 netif_carrier_off(dev); 6101 6102 /* Some NICs freeze when TX pause is enabled while NIC is 6103 * down, and this stays across warm reboots. The sequence 6104 * below should be enough to recover from that state. 6105 */ 6106 nv_update_pause(dev, 0); 6107 nv_start_tx(dev); 6108 nv_stop_tx(dev); 6109 6110 if (id->driver_data & DEV_HAS_VLAN) 6111 nv_vlan_mode(dev, dev->features); 6112 6113 dev_info(&pci_dev->dev, "ifname %s, PHY OUI 0x%x @ %d, addr %pM\n", 6114 dev->name, np->phy_oui, np->phyaddr, dev->dev_addr); 6115 6116 dev_info(&pci_dev->dev, "%s%s%s%s%s%s%s%s%s%s%sdesc-v%u\n", 6117 dev->features & NETIF_F_HIGHDMA ? "highdma " : "", 6118 dev->features & (NETIF_F_IP_CSUM | NETIF_F_SG) ? 6119 "csum " : "", 6120 dev->features & (NETIF_F_HW_VLAN_CTAG_RX | 6121 NETIF_F_HW_VLAN_CTAG_TX) ? 6122 "vlan " : "", 6123 dev->features & (NETIF_F_LOOPBACK) ? 6124 "loopback " : "", 6125 id->driver_data & DEV_HAS_POWER_CNTRL ? "pwrctl " : "", 6126 id->driver_data & DEV_HAS_MGMT_UNIT ? "mgmt " : "", 6127 id->driver_data & DEV_NEED_TIMERIRQ ? "timirq " : "", 6128 np->gigabit == PHY_GIGABIT ? "gbit " : "", 6129 np->need_linktimer ? "lnktim " : "", 6130 np->msi_flags & NV_MSI_CAPABLE ? "msi " : "", 6131 np->msi_flags & NV_MSI_X_CAPABLE ? "msi-x " : "", 6132 np->desc_ver); 6133 6134 return 0; 6135 6136 out_error: 6137 if (phystate_orig) 6138 writel(phystate|NVREG_ADAPTCTL_RUNNING, base + NvRegAdapterControl); 6139 out_freering: 6140 free_rings(dev); 6141 out_unmap: 6142 iounmap(get_hwbase(dev)); 6143 out_relreg: 6144 pci_release_regions(pci_dev); 6145 out_disable: 6146 pci_disable_device(pci_dev); 6147 out_free: 6148 free_percpu(np->txrx_stats); 6149 out_alloc_percpu: 6150 free_netdev(dev); 6151 out: 6152 return err; 6153 } 6154 6155 static void nv_restore_phy(struct net_device *dev) 6156 { 6157 struct fe_priv *np = netdev_priv(dev); 6158 u16 phy_reserved, mii_control; 6159 6160 if (np->phy_oui == PHY_OUI_REALTEK && 6161 np->phy_model == PHY_MODEL_REALTEK_8201 && 6162 phy_cross == NV_CROSSOVER_DETECTION_DISABLED) { 6163 mii_rw(dev, np->phyaddr, PHY_REALTEK_INIT_REG1, PHY_REALTEK_INIT3); 6164 phy_reserved = mii_rw(dev, np->phyaddr, PHY_REALTEK_INIT_REG2, MII_READ); 6165 phy_reserved &= ~PHY_REALTEK_INIT_MSK1; 6166 phy_reserved |= PHY_REALTEK_INIT8; 6167 mii_rw(dev, np->phyaddr, PHY_REALTEK_INIT_REG2, phy_reserved); 6168 mii_rw(dev, np->phyaddr, PHY_REALTEK_INIT_REG1, PHY_REALTEK_INIT1); 6169 6170 /* restart auto negotiation */ 6171 mii_control = mii_rw(dev, np->phyaddr, MII_BMCR, MII_READ); 6172 mii_control |= (BMCR_ANRESTART | BMCR_ANENABLE); 6173 mii_rw(dev, np->phyaddr, MII_BMCR, mii_control); 6174 } 6175 } 6176 6177 static void nv_restore_mac_addr(struct pci_dev *pci_dev) 6178 { 6179 struct net_device *dev = pci_get_drvdata(pci_dev); 6180 struct fe_priv *np = netdev_priv(dev); 6181 u8 __iomem *base = get_hwbase(dev); 6182 6183 /* special op: write back the misordered MAC address - otherwise 6184 * the next nv_probe would see a wrong address. 6185 */ 6186 writel(np->orig_mac[0], base + NvRegMacAddrA); 6187 writel(np->orig_mac[1], base + NvRegMacAddrB); 6188 writel(readl(base + NvRegTransmitPoll) & ~NVREG_TRANSMITPOLL_MAC_ADDR_REV, 6189 base + NvRegTransmitPoll); 6190 } 6191 6192 static void nv_remove(struct pci_dev *pci_dev) 6193 { 6194 struct net_device *dev = pci_get_drvdata(pci_dev); 6195 struct fe_priv *np = netdev_priv(dev); 6196 6197 free_percpu(np->txrx_stats); 6198 6199 unregister_netdev(dev); 6200 6201 nv_restore_mac_addr(pci_dev); 6202 6203 /* restore any phy related changes */ 6204 nv_restore_phy(dev); 6205 6206 nv_mgmt_release_sema(dev); 6207 6208 /* free all structures */ 6209 free_rings(dev); 6210 iounmap(get_hwbase(dev)); 6211 pci_release_regions(pci_dev); 6212 pci_disable_device(pci_dev); 6213 free_netdev(dev); 6214 } 6215 6216 #ifdef CONFIG_PM_SLEEP 6217 static int nv_suspend(struct device *device) 6218 { 6219 struct net_device *dev = dev_get_drvdata(device); 6220 struct fe_priv *np = netdev_priv(dev); 6221 u8 __iomem *base = get_hwbase(dev); 6222 int i; 6223 6224 if (netif_running(dev)) { 6225 /* Gross. */ 6226 nv_close(dev); 6227 } 6228 netif_device_detach(dev); 6229 6230 /* save non-pci configuration space */ 6231 for (i = 0; i <= np->register_size/sizeof(u32); i++) 6232 np->saved_config_space[i] = readl(base + i*sizeof(u32)); 6233 6234 return 0; 6235 } 6236 6237 static int nv_resume(struct device *device) 6238 { 6239 struct pci_dev *pdev = to_pci_dev(device); 6240 struct net_device *dev = pci_get_drvdata(pdev); 6241 struct fe_priv *np = netdev_priv(dev); 6242 u8 __iomem *base = get_hwbase(dev); 6243 int i, rc = 0; 6244 6245 /* restore non-pci configuration space */ 6246 for (i = 0; i <= np->register_size/sizeof(u32); i++) 6247 writel(np->saved_config_space[i], base+i*sizeof(u32)); 6248 6249 if (np->driver_data & DEV_NEED_MSI_FIX) 6250 pci_write_config_dword(pdev, NV_MSI_PRIV_OFFSET, NV_MSI_PRIV_VALUE); 6251 6252 /* restore phy state, including autoneg */ 6253 phy_init(dev); 6254 6255 netif_device_attach(dev); 6256 if (netif_running(dev)) { 6257 rc = nv_open(dev); 6258 nv_set_multicast(dev); 6259 } 6260 return rc; 6261 } 6262 6263 static SIMPLE_DEV_PM_OPS(nv_pm_ops, nv_suspend, nv_resume); 6264 #define NV_PM_OPS (&nv_pm_ops) 6265 6266 #else 6267 #define NV_PM_OPS NULL 6268 #endif /* CONFIG_PM_SLEEP */ 6269 6270 #ifdef CONFIG_PM 6271 static void nv_shutdown(struct pci_dev *pdev) 6272 { 6273 struct net_device *dev = pci_get_drvdata(pdev); 6274 struct fe_priv *np = netdev_priv(dev); 6275 6276 if (netif_running(dev)) 6277 nv_close(dev); 6278 6279 /* 6280 * Restore the MAC so a kernel started by kexec won't get confused. 6281 * If we really go for poweroff, we must not restore the MAC, 6282 * otherwise the MAC for WOL will be reversed at least on some boards. 6283 */ 6284 if (system_state != SYSTEM_POWER_OFF) 6285 nv_restore_mac_addr(pdev); 6286 6287 pci_disable_device(pdev); 6288 /* 6289 * Apparently it is not possible to reinitialise from D3 hot, 6290 * only put the device into D3 if we really go for poweroff. 6291 */ 6292 if (system_state == SYSTEM_POWER_OFF) { 6293 pci_wake_from_d3(pdev, np->wolenabled); 6294 pci_set_power_state(pdev, PCI_D3hot); 6295 } 6296 } 6297 #else 6298 #define nv_shutdown NULL 6299 #endif /* CONFIG_PM */ 6300 6301 static const struct pci_device_id pci_tbl[] = { 6302 { /* nForce Ethernet Controller */ 6303 PCI_DEVICE(0x10DE, 0x01C3), 6304 .driver_data = DEV_NEED_TIMERIRQ|DEV_NEED_LINKTIMER, 6305 }, 6306 { /* nForce2 Ethernet Controller */ 6307 PCI_DEVICE(0x10DE, 0x0066), 6308 .driver_data = DEV_NEED_TIMERIRQ|DEV_NEED_LINKTIMER, 6309 }, 6310 { /* nForce3 Ethernet Controller */ 6311 PCI_DEVICE(0x10DE, 0x00D6), 6312 .driver_data = DEV_NEED_TIMERIRQ|DEV_NEED_LINKTIMER, 6313 }, 6314 { /* nForce3 Ethernet Controller */ 6315 PCI_DEVICE(0x10DE, 0x0086), 6316 .driver_data = DEV_NEED_TIMERIRQ|DEV_NEED_LINKTIMER|DEV_HAS_LARGEDESC|DEV_HAS_CHECKSUM, 6317 }, 6318 { /* nForce3 Ethernet Controller */ 6319 PCI_DEVICE(0x10DE, 0x008C), 6320 .driver_data = DEV_NEED_TIMERIRQ|DEV_NEED_LINKTIMER|DEV_HAS_LARGEDESC|DEV_HAS_CHECKSUM, 6321 }, 6322 { /* nForce3 Ethernet Controller */ 6323 PCI_DEVICE(0x10DE, 0x00E6), 6324 .driver_data = DEV_NEED_TIMERIRQ|DEV_NEED_LINKTIMER|DEV_HAS_LARGEDESC|DEV_HAS_CHECKSUM, 6325 }, 6326 { /* nForce3 Ethernet Controller */ 6327 PCI_DEVICE(0x10DE, 0x00DF), 6328 .driver_data = DEV_NEED_TIMERIRQ|DEV_NEED_LINKTIMER|DEV_HAS_LARGEDESC|DEV_HAS_CHECKSUM, 6329 }, 6330 { /* CK804 Ethernet Controller */ 6331 PCI_DEVICE(0x10DE, 0x0056), 6332 .driver_data = DEV_NEED_LINKTIMER|DEV_HAS_LARGEDESC|DEV_HAS_CHECKSUM|DEV_HAS_HIGH_DMA|DEV_HAS_STATISTICS_V1|DEV_NEED_TX_LIMIT, 6333 }, 6334 { /* CK804 Ethernet Controller */ 6335 PCI_DEVICE(0x10DE, 0x0057), 6336 .driver_data = DEV_NEED_LINKTIMER|DEV_HAS_LARGEDESC|DEV_HAS_CHECKSUM|DEV_HAS_HIGH_DMA|DEV_HAS_STATISTICS_V1|DEV_NEED_TX_LIMIT, 6337 }, 6338 { /* MCP04 Ethernet Controller */ 6339 PCI_DEVICE(0x10DE, 0x0037), 6340 .driver_data = DEV_NEED_LINKTIMER|DEV_HAS_LARGEDESC|DEV_HAS_CHECKSUM|DEV_HAS_HIGH_DMA|DEV_HAS_STATISTICS_V1|DEV_NEED_TX_LIMIT, 6341 }, 6342 { /* MCP04 Ethernet Controller */ 6343 PCI_DEVICE(0x10DE, 0x0038), 6344 .driver_data = DEV_NEED_LINKTIMER|DEV_HAS_LARGEDESC|DEV_HAS_CHECKSUM|DEV_HAS_HIGH_DMA|DEV_HAS_STATISTICS_V1|DEV_NEED_TX_LIMIT, 6345 }, 6346 { /* MCP51 Ethernet Controller */ 6347 PCI_DEVICE(0x10DE, 0x0268), 6348 .driver_data = DEV_NEED_LINKTIMER|DEV_HAS_HIGH_DMA|DEV_HAS_POWER_CNTRL|DEV_HAS_STATISTICS_V1|DEV_NEED_LOW_POWER_FIX, 6349 }, 6350 { /* MCP51 Ethernet Controller */ 6351 PCI_DEVICE(0x10DE, 0x0269), 6352 .driver_data = DEV_NEED_LINKTIMER|DEV_HAS_HIGH_DMA|DEV_HAS_POWER_CNTRL|DEV_HAS_STATISTICS_V1|DEV_NEED_LOW_POWER_FIX, 6353 }, 6354 { /* MCP55 Ethernet Controller */ 6355 PCI_DEVICE(0x10DE, 0x0372), 6356 .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, 6357 }, 6358 { /* MCP55 Ethernet Controller */ 6359 PCI_DEVICE(0x10DE, 0x0373), 6360 .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, 6361 }, 6362 { /* MCP61 Ethernet Controller */ 6363 PCI_DEVICE(0x10DE, 0x03E5), 6364 .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, 6365 }, 6366 { /* MCP61 Ethernet Controller */ 6367 PCI_DEVICE(0x10DE, 0x03E6), 6368 .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, 6369 }, 6370 { /* MCP61 Ethernet Controller */ 6371 PCI_DEVICE(0x10DE, 0x03EE), 6372 .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, 6373 }, 6374 { /* MCP61 Ethernet Controller */ 6375 PCI_DEVICE(0x10DE, 0x03EF), 6376 .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, 6377 }, 6378 { /* MCP65 Ethernet Controller */ 6379 PCI_DEVICE(0x10DE, 0x0450), 6380 .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, 6381 }, 6382 { /* MCP65 Ethernet Controller */ 6383 PCI_DEVICE(0x10DE, 0x0451), 6384 .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, 6385 }, 6386 { /* MCP65 Ethernet Controller */ 6387 PCI_DEVICE(0x10DE, 0x0452), 6388 .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, 6389 }, 6390 { /* MCP65 Ethernet Controller */ 6391 PCI_DEVICE(0x10DE, 0x0453), 6392 .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, 6393 }, 6394 { /* MCP67 Ethernet Controller */ 6395 PCI_DEVICE(0x10DE, 0x054C), 6396 .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, 6397 }, 6398 { /* MCP67 Ethernet Controller */ 6399 PCI_DEVICE(0x10DE, 0x054D), 6400 .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, 6401 }, 6402 { /* MCP67 Ethernet Controller */ 6403 PCI_DEVICE(0x10DE, 0x054E), 6404 .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, 6405 }, 6406 { /* MCP67 Ethernet Controller */ 6407 PCI_DEVICE(0x10DE, 0x054F), 6408 .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, 6409 }, 6410 { /* MCP73 Ethernet Controller */ 6411 PCI_DEVICE(0x10DE, 0x07DC), 6412 .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, 6413 }, 6414 { /* MCP73 Ethernet Controller */ 6415 PCI_DEVICE(0x10DE, 0x07DD), 6416 .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, 6417 }, 6418 { /* MCP73 Ethernet Controller */ 6419 PCI_DEVICE(0x10DE, 0x07DE), 6420 .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, 6421 }, 6422 { /* MCP73 Ethernet Controller */ 6423 PCI_DEVICE(0x10DE, 0x07DF), 6424 .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, 6425 }, 6426 { /* MCP77 Ethernet Controller */ 6427 PCI_DEVICE(0x10DE, 0x0760), 6428 .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, 6429 }, 6430 { /* MCP77 Ethernet Controller */ 6431 PCI_DEVICE(0x10DE, 0x0761), 6432 .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, 6433 }, 6434 { /* MCP77 Ethernet Controller */ 6435 PCI_DEVICE(0x10DE, 0x0762), 6436 .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, 6437 }, 6438 { /* MCP77 Ethernet Controller */ 6439 PCI_DEVICE(0x10DE, 0x0763), 6440 .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, 6441 }, 6442 { /* MCP79 Ethernet Controller */ 6443 PCI_DEVICE(0x10DE, 0x0AB0), 6444 .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, 6445 }, 6446 { /* MCP79 Ethernet Controller */ 6447 PCI_DEVICE(0x10DE, 0x0AB1), 6448 .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, 6449 }, 6450 { /* MCP79 Ethernet Controller */ 6451 PCI_DEVICE(0x10DE, 0x0AB2), 6452 .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, 6453 }, 6454 { /* MCP79 Ethernet Controller */ 6455 PCI_DEVICE(0x10DE, 0x0AB3), 6456 .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, 6457 }, 6458 { /* MCP89 Ethernet Controller */ 6459 PCI_DEVICE(0x10DE, 0x0D7D), 6460 .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, 6461 }, 6462 {0,}, 6463 }; 6464 6465 static struct pci_driver forcedeth_pci_driver = { 6466 .name = DRV_NAME, 6467 .id_table = pci_tbl, 6468 .probe = nv_probe, 6469 .remove = nv_remove, 6470 .shutdown = nv_shutdown, 6471 .driver.pm = NV_PM_OPS, 6472 }; 6473 6474 module_param(max_interrupt_work, int, 0); 6475 MODULE_PARM_DESC(max_interrupt_work, "forcedeth maximum events handled per interrupt"); 6476 module_param(optimization_mode, int, 0); 6477 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."); 6478 module_param(poll_interval, int, 0); 6479 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."); 6480 module_param(msi, int, 0); 6481 MODULE_PARM_DESC(msi, "MSI interrupts are enabled by setting to 1 and disabled by setting to 0."); 6482 module_param(msix, int, 0); 6483 MODULE_PARM_DESC(msix, "MSIX interrupts are enabled by setting to 1 and disabled by setting to 0."); 6484 module_param(dma_64bit, int, 0); 6485 MODULE_PARM_DESC(dma_64bit, "High DMA is enabled by setting to 1 and disabled by setting to 0."); 6486 module_param(phy_cross, int, 0); 6487 MODULE_PARM_DESC(phy_cross, "Phy crossover detection for Realtek 8201 phy is enabled by setting to 1 and disabled by setting to 0."); 6488 module_param(phy_power_down, int, 0); 6489 MODULE_PARM_DESC(phy_power_down, "Power down phy and disable link when interface is down (1), or leave phy powered up (0)."); 6490 module_param(debug_tx_timeout, bool, 0); 6491 MODULE_PARM_DESC(debug_tx_timeout, 6492 "Dump tx related registers and ring when tx_timeout happens"); 6493 6494 module_pci_driver(forcedeth_pci_driver); 6495 MODULE_AUTHOR("Manfred Spraul <manfred@colorfullife.com>"); 6496 MODULE_DESCRIPTION("Reverse Engineered nForce ethernet driver"); 6497 MODULE_LICENSE("GPL"); 6498 MODULE_DEVICE_TABLE(pci, pci_tbl); 6499