Blame view
drivers/net/ethernet/jme.c
74 KB
95252236e jme: JMicron Giga... |
1 2 3 4 5 |
/* * JMicron JMC2x0 series PCIe Ethernet Linux Device Driver * * Copyright 2008 JMicron Technology Corporation * http://www.jmicron.com/ |
e47dfcd81 jme: Advance vers... |
6 |
* Copyright (c) 2009 - 2010 Guo-Fu Tseng <cooldavid@cooldavid.org> |
95252236e jme: JMicron Giga... |
7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 |
* * Author: Guo-Fu Tseng <cooldavid@cooldavid.org> * * This program is free software; you can redistribute it and/or modify * it under the terms of the GNU General Public License as published by * the Free Software Foundation; either version 2 of the License. * * This program is distributed in the hope that it will be useful, * but WITHOUT ANY WARRANTY; without even the implied warranty of * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the * GNU General Public License for more details. * * You should have received a copy of the GNU General Public License * along with this program; if not, write to the Free Software * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA. * */ |
49d70c485 drivers/net/jme: ... |
24 |
#define pr_fmt(fmt) KBUILD_MODNAME ": " fmt |
95252236e jme: JMicron Giga... |
25 26 27 |
#include <linux/module.h> #include <linux/kernel.h> #include <linux/pci.h> |
aac9453b6 net/ethernet/jme:... |
28 |
#include <linux/pci-aspm.h> |
95252236e jme: JMicron Giga... |
29 30 31 32 33 34 35 36 37 38 39 40 41 |
#include <linux/netdevice.h> #include <linux/etherdevice.h> #include <linux/ethtool.h> #include <linux/mii.h> #include <linux/crc32.h> #include <linux/delay.h> #include <linux/spinlock.h> #include <linux/in.h> #include <linux/ip.h> #include <linux/ipv6.h> #include <linux/tcp.h> #include <linux/udp.h> #include <linux/if_vlan.h> |
5a0e3ad6a include cleanup: ... |
42 |
#include <linux/slab.h> |
b7c6bfb71 net: fix driver b... |
43 |
#include <net/ip6_checksum.h> |
95252236e jme: JMicron Giga... |
44 45 46 47 48 49 50 51 52 53 54 55 56 57 58 59 60 61 62 63 64 65 66 67 68 69 70 71 72 73 74 75 76 77 |
#include "jme.h" static int force_pseudohp = -1; static int no_pseudohp = -1; static int no_extplug = -1; module_param(force_pseudohp, int, 0); MODULE_PARM_DESC(force_pseudohp, "Enable pseudo hot-plug feature manually by driver instead of BIOS."); module_param(no_pseudohp, int, 0); MODULE_PARM_DESC(no_pseudohp, "Disable pseudo hot-plug feature."); module_param(no_extplug, int, 0); MODULE_PARM_DESC(no_extplug, "Do not use external plug signal for pseudo hot-plug."); static int jme_mdio_read(struct net_device *netdev, int phy, int reg) { struct jme_adapter *jme = netdev_priv(netdev); int i, val, again = (reg == MII_BMSR) ? 1 : 0; read_again: jwrite32(jme, JME_SMI, SMI_OP_REQ | smi_phy_addr(phy) | smi_reg_addr(reg)); wmb(); for (i = JME_PHY_TIMEOUT * 50 ; i > 0 ; --i) { udelay(20); val = jread32(jme, JME_SMI); if ((val & SMI_OP_REQ) == 0) break; } if (i == 0) { |
49d70c485 drivers/net/jme: ... |
78 79 |
pr_err("phy(%d) read timeout : %d ", phy, reg); |
95252236e jme: JMicron Giga... |
80 81 82 83 84 85 86 87 88 89 90 91 92 93 94 95 96 97 98 99 100 101 102 103 104 105 106 107 |
return 0; } if (again--) goto read_again; return (val & SMI_DATA_MASK) >> SMI_DATA_SHIFT; } static void jme_mdio_write(struct net_device *netdev, int phy, int reg, int val) { struct jme_adapter *jme = netdev_priv(netdev); int i; jwrite32(jme, JME_SMI, SMI_OP_WRITE | SMI_OP_REQ | ((val << SMI_DATA_SHIFT) & SMI_DATA_MASK) | smi_phy_addr(phy) | smi_reg_addr(reg)); wmb(); for (i = JME_PHY_TIMEOUT * 50 ; i > 0 ; --i) { udelay(20); if ((jread32(jme, JME_SMI) & SMI_OP_REQ) == 0) break; } if (i == 0) |
49d70c485 drivers/net/jme: ... |
108 109 |
pr_err("phy(%d) write timeout : %d ", phy, reg); |
95252236e jme: JMicron Giga... |
110 111 112 113 114 115 116 117 118 119 120 121 122 123 124 125 126 127 128 129 130 131 132 133 134 |
} static inline void jme_reset_phy_processor(struct jme_adapter *jme) { u32 val; jme_mdio_write(jme->dev, jme->mii_if.phy_id, MII_ADVERTISE, ADVERTISE_ALL | ADVERTISE_PAUSE_CAP | ADVERTISE_PAUSE_ASYM); if (jme->pdev->device == PCI_DEVICE_ID_JMICRON_JMC250) jme_mdio_write(jme->dev, jme->mii_if.phy_id, MII_CTRL1000, ADVERTISE_1000FULL | ADVERTISE_1000HALF); val = jme_mdio_read(jme->dev, jme->mii_if.phy_id, MII_BMCR); jme_mdio_write(jme->dev, jme->mii_if.phy_id, MII_BMCR, val | BMCR_RESET); |
95252236e jme: JMicron Giga... |
135 136 137 138 |
} static void jme_setup_wakeup_frame(struct jme_adapter *jme, |
b6bc76506 drivers/net/*.c: ... |
139 |
const u32 *mask, u32 crc, int fnr) |
95252236e jme: JMicron Giga... |
140 141 142 143 144 145 146 147 148 149 150 151 152 153 154 155 156 157 158 159 160 161 162 163 164 |
{ int i; /* * Setup CRC pattern */ jwrite32(jme, JME_WFOI, WFOI_CRC_SEL | (fnr & WFOI_FRAME_SEL)); wmb(); jwrite32(jme, JME_WFODP, crc); wmb(); /* * Setup Mask */ for (i = 0 ; i < WAKEUP_FRAME_MASK_DWNR ; ++i) { jwrite32(jme, JME_WFOI, ((i << WFOI_MASK_SHIFT) & WFOI_MASK_SEL) | (fnr & WFOI_FRAME_SEL)); wmb(); jwrite32(jme, JME_WFODP, mask[i]); wmb(); } } static inline void |
854a2e7c3 jme: Safer MAC pr... |
165 166 167 168 169 170 171 172 173 174 175 176 177 178 179 180 181 182 183 184 185 186 187 188 189 190 191 192 193 194 195 196 197 198 199 200 201 202 203 204 205 206 207 208 209 210 211 212 213 214 215 216 217 218 219 220 221 222 223 224 225 |
jme_mac_rxclk_off(struct jme_adapter *jme) { jme->reg_gpreg1 |= GPREG1_RXCLKOFF; jwrite32f(jme, JME_GPREG1, jme->reg_gpreg1); } static inline void jme_mac_rxclk_on(struct jme_adapter *jme) { jme->reg_gpreg1 &= ~GPREG1_RXCLKOFF; jwrite32f(jme, JME_GPREG1, jme->reg_gpreg1); } static inline void jme_mac_txclk_off(struct jme_adapter *jme) { jme->reg_ghc &= ~(GHC_TO_CLK_SRC | GHC_TXMAC_CLK_SRC); jwrite32f(jme, JME_GHC, jme->reg_ghc); } static inline void jme_mac_txclk_on(struct jme_adapter *jme) { u32 speed = jme->reg_ghc & GHC_SPEED; if (speed == GHC_SPEED_1000M) jme->reg_ghc |= GHC_TO_CLK_GPHY | GHC_TXMAC_CLK_GPHY; else jme->reg_ghc |= GHC_TO_CLK_PCIE | GHC_TXMAC_CLK_PCIE; jwrite32f(jme, JME_GHC, jme->reg_ghc); } static inline void jme_reset_ghc_speed(struct jme_adapter *jme) { jme->reg_ghc &= ~(GHC_SPEED | GHC_DPX); jwrite32f(jme, JME_GHC, jme->reg_ghc); } static inline void jme_reset_250A2_workaround(struct jme_adapter *jme) { jme->reg_gpreg1 &= ~(GPREG1_HALFMODEPATCH | GPREG1_RSSPATCH); jwrite32(jme, JME_GPREG1, jme->reg_gpreg1); } static inline void jme_assert_ghc_reset(struct jme_adapter *jme) { jme->reg_ghc |= GHC_SWRST; jwrite32f(jme, JME_GHC, jme->reg_ghc); } static inline void jme_clear_ghc_reset(struct jme_adapter *jme) { jme->reg_ghc &= ~GHC_SWRST; jwrite32f(jme, JME_GHC, jme->reg_ghc); } static inline void |
95252236e jme: JMicron Giga... |
226 227 |
jme_reset_mac_processor(struct jme_adapter *jme) { |
b6bc76506 drivers/net/*.c: ... |
228 |
static const u32 mask[WAKEUP_FRAME_MASK_DWNR] = {0, 0, 0, 0}; |
95252236e jme: JMicron Giga... |
229 230 231 |
u32 crc = 0xCDCDCDCD; u32 gpreg0; int i; |
854a2e7c3 jme: Safer MAC pr... |
232 233 234 235 236 237 238 239 240 241 242 243 244 245 246 247 248 249 |
jme_reset_ghc_speed(jme); jme_reset_250A2_workaround(jme); jme_mac_rxclk_on(jme); jme_mac_txclk_on(jme); udelay(1); jme_assert_ghc_reset(jme); udelay(1); jme_mac_rxclk_off(jme); jme_mac_txclk_off(jme); udelay(1); jme_clear_ghc_reset(jme); udelay(1); jme_mac_rxclk_on(jme); jme_mac_txclk_on(jme); udelay(1); jme_mac_rxclk_off(jme); jme_mac_txclk_off(jme); |
95252236e jme: JMicron Giga... |
250 251 252 253 254 255 256 257 258 259 260 261 262 263 264 265 266 267 268 |
jwrite32(jme, JME_RXDBA_LO, 0x00000000); jwrite32(jme, JME_RXDBA_HI, 0x00000000); jwrite32(jme, JME_RXQDC, 0x00000000); jwrite32(jme, JME_RXNDA, 0x00000000); jwrite32(jme, JME_TXDBA_LO, 0x00000000); jwrite32(jme, JME_TXDBA_HI, 0x00000000); jwrite32(jme, JME_TXQDC, 0x00000000); jwrite32(jme, JME_TXNDA, 0x00000000); jwrite32(jme, JME_RXMCHT_LO, 0x00000000); jwrite32(jme, JME_RXMCHT_HI, 0x00000000); for (i = 0 ; i < WAKEUP_FRAME_NR ; ++i) jme_setup_wakeup_frame(jme, mask, crc, i); if (jme->fpgaver) gpreg0 = GPREG0_DEFAULT | GPREG0_LNKINTPOLL; else gpreg0 = GPREG0_DEFAULT; jwrite32(jme, JME_GPREG0, gpreg0); |
95252236e jme: JMicron Giga... |
269 270 271 272 273 |
} static inline void jme_clear_pm(struct jme_adapter *jme) { |
bc057e036 jme: Cleanup PM o... |
274 |
jwrite32(jme, JME_PMCS, PMCS_STMASK | jme->reg_pmcs); |
95252236e jme: JMicron Giga... |
275 276 277 278 279 280 281 282 283 284 285 286 287 288 289 290 291 292 293 294 295 296 297 298 |
} static int jme_reload_eeprom(struct jme_adapter *jme) { u32 val; int i; val = jread32(jme, JME_SMBCSR); if (val & SMBCSR_EEPROMD) { val |= SMBCSR_CNACK; jwrite32(jme, JME_SMBCSR, val); val |= SMBCSR_RELOAD; jwrite32(jme, JME_SMBCSR, val); mdelay(12); for (i = JME_EEPROM_RELOAD_TIMEOUT; i > 0; --i) { mdelay(1); if ((jread32(jme, JME_SMBCSR) & SMBCSR_RELOAD) == 0) break; } if (i == 0) { |
49d70c485 drivers/net/jme: ... |
299 300 |
pr_err("eeprom reload timeout "); |
95252236e jme: JMicron Giga... |
301 302 303 304 305 306 307 308 309 310 311 |
return -EIO; } } return 0; } static void jme_load_macaddr(struct net_device *netdev) { struct jme_adapter *jme = netdev_priv(netdev); |
d458cdf71 net:drivers/net: ... |
312 |
unsigned char macaddr[ETH_ALEN]; |
95252236e jme: JMicron Giga... |
313 314 315 316 317 318 319 320 321 322 323 |
u32 val; spin_lock_bh(&jme->macaddr_lock); val = jread32(jme, JME_RXUMA_LO); macaddr[0] = (val >> 0) & 0xFF; macaddr[1] = (val >> 8) & 0xFF; macaddr[2] = (val >> 16) & 0xFF; macaddr[3] = (val >> 24) & 0xFF; val = jread32(jme, JME_RXUMA_HI); macaddr[4] = (val >> 0) & 0xFF; macaddr[5] = (val >> 8) & 0xFF; |
d458cdf71 net:drivers/net: ... |
324 |
memcpy(netdev->dev_addr, macaddr, ETH_ALEN); |
95252236e jme: JMicron Giga... |
325 326 327 328 329 330 331 332 333 334 335 336 337 338 339 340 341 342 343 344 345 346 347 348 349 350 351 352 353 354 355 356 357 |
spin_unlock_bh(&jme->macaddr_lock); } static inline void jme_set_rx_pcc(struct jme_adapter *jme, int p) { switch (p) { case PCC_OFF: jwrite32(jme, JME_PCCRX0, ((PCC_OFF_TO << PCCRXTO_SHIFT) & PCCRXTO_MASK) | ((PCC_OFF_CNT << PCCRX_SHIFT) & PCCRX_MASK)); break; case PCC_P1: jwrite32(jme, JME_PCCRX0, ((PCC_P1_TO << PCCRXTO_SHIFT) & PCCRXTO_MASK) | ((PCC_P1_CNT << PCCRX_SHIFT) & PCCRX_MASK)); break; case PCC_P2: jwrite32(jme, JME_PCCRX0, ((PCC_P2_TO << PCCRXTO_SHIFT) & PCCRXTO_MASK) | ((PCC_P2_CNT << PCCRX_SHIFT) & PCCRX_MASK)); break; case PCC_P3: jwrite32(jme, JME_PCCRX0, ((PCC_P3_TO << PCCRXTO_SHIFT) & PCCRXTO_MASK) | ((PCC_P3_CNT << PCCRX_SHIFT) & PCCRX_MASK)); break; default: break; } wmb(); if (!(test_bit(JME_FLAG_POLL, &jme->flags))) |
f8502ce4f drivers/net/jme: ... |
358 359 |
netif_info(jme, rx_status, jme->dev, "Switched to PCC_P%d ", p); |
95252236e jme: JMicron Giga... |
360 361 362 363 364 365 366 367 368 369 370 371 372 373 374 375 376 377 378 379 380 381 382 383 384 385 386 387 388 389 390 391 |
} static void jme_start_irq(struct jme_adapter *jme) { register struct dynpcc_info *dpi = &(jme->dpi); jme_set_rx_pcc(jme, PCC_P1); dpi->cur = PCC_P1; dpi->attempt = PCC_P1; dpi->cnt = 0; jwrite32(jme, JME_PCCTX, ((PCC_TX_TO << PCCTXTO_SHIFT) & PCCTXTO_MASK) | ((PCC_TX_CNT << PCCTX_SHIFT) & PCCTX_MASK) | PCCTXQ0_EN ); /* * Enable Interrupts */ jwrite32(jme, JME_IENS, INTR_ENABLE); } static inline void jme_stop_irq(struct jme_adapter *jme) { /* * Disable Interrupts */ jwrite32f(jme, JME_IENC, INTR_ENABLE); } |
95252236e jme: JMicron Giga... |
392 393 394 395 396 397 398 399 400 401 402 403 404 405 |
static u32 jme_linkstat_from_phy(struct jme_adapter *jme) { u32 phylink, bmsr; phylink = jme_mdio_read(jme->dev, jme->mii_if.phy_id, 17); bmsr = jme_mdio_read(jme->dev, jme->mii_if.phy_id, MII_BMSR); if (bmsr & BMSR_ANCOMP) phylink |= PHY_LINK_AUTONEG_COMPLETE; return phylink; } static inline void |
517545723 jme: Rename phyfi... |
406 |
jme_set_phyfifo_5level(struct jme_adapter *jme) |
95252236e jme: JMicron Giga... |
407 408 409 410 411 |
{ jme_mdio_write(jme->dev, jme->mii_if.phy_id, 27, 0x0004); } static inline void |
517545723 jme: Rename phyfi... |
412 |
jme_set_phyfifo_8level(struct jme_adapter *jme) |
95252236e jme: JMicron Giga... |
413 414 415 416 417 418 419 420 |
{ jme_mdio_write(jme->dev, jme->mii_if.phy_id, 27, 0x0000); } static int jme_check_link(struct net_device *netdev, int testonly) { struct jme_adapter *jme = netdev_priv(netdev); |
854a2e7c3 jme: Safer MAC pr... |
421 |
u32 phylink, cnt = JME_SPDRSV_TIMEOUT, bmcr; |
95252236e jme: JMicron Giga... |
422 423 424 425 426 427 428 429 430 431 432 433 434 435 436 437 438 439 440 441 442 443 444 445 446 447 448 449 450 451 452 453 454 455 456 457 458 459 460 461 462 463 464 465 466 467 468 469 |
char linkmsg[64]; int rc = 0; linkmsg[0] = '\0'; if (jme->fpgaver) phylink = jme_linkstat_from_phy(jme); else phylink = jread32(jme, JME_PHY_LINK); if (phylink & PHY_LINK_UP) { if (!(phylink & PHY_LINK_AUTONEG_COMPLETE)) { /* * If we did not enable AN * Speed/Duplex Info should be obtained from SMI */ phylink = PHY_LINK_UP; bmcr = jme_mdio_read(jme->dev, jme->mii_if.phy_id, MII_BMCR); phylink |= ((bmcr & BMCR_SPEED1000) && (bmcr & BMCR_SPEED100) == 0) ? PHY_LINK_SPEED_1000M : (bmcr & BMCR_SPEED100) ? PHY_LINK_SPEED_100M : PHY_LINK_SPEED_10M; phylink |= (bmcr & BMCR_FULLDPLX) ? PHY_LINK_DUPLEX : 0; strcat(linkmsg, "Forced: "); } else { /* * Keep polling for speed/duplex resolve complete */ while (!(phylink & PHY_LINK_SPEEDDPU_RESOLVED) && --cnt) { udelay(1); if (jme->fpgaver) phylink = jme_linkstat_from_phy(jme); else phylink = jread32(jme, JME_PHY_LINK); } if (!cnt) |
49d70c485 drivers/net/jme: ... |
470 471 |
pr_err("Waiting speed resolve timeout "); |
95252236e jme: JMicron Giga... |
472 473 474 475 476 477 478 479 480 481 482 483 |
strcat(linkmsg, "ANed: "); } if (jme->phylink == phylink) { rc = 1; goto out; } if (testonly) goto out; jme->phylink = phylink; |
854a2e7c3 jme: Safer MAC pr... |
484 485 486 487 |
/* * The speed/duplex setting of jme->reg_ghc already cleared * by jme_reset_mac_processor() */ |
95252236e jme: JMicron Giga... |
488 489 |
switch (phylink & PHY_LINK_SPEED_MASK) { case PHY_LINK_SPEED_10M: |
854a2e7c3 jme: Safer MAC pr... |
490 |
jme->reg_ghc |= GHC_SPEED_10M; |
95252236e jme: JMicron Giga... |
491 |
strcat(linkmsg, "10 Mbps, "); |
95252236e jme: JMicron Giga... |
492 493 |
break; case PHY_LINK_SPEED_100M: |
854a2e7c3 jme: Safer MAC pr... |
494 |
jme->reg_ghc |= GHC_SPEED_100M; |
95252236e jme: JMicron Giga... |
495 |
strcat(linkmsg, "100 Mbps, "); |
95252236e jme: JMicron Giga... |
496 497 |
break; case PHY_LINK_SPEED_1000M: |
854a2e7c3 jme: Safer MAC pr... |
498 |
jme->reg_ghc |= GHC_SPEED_1000M; |
95252236e jme: JMicron Giga... |
499 |
strcat(linkmsg, "1000 Mbps, "); |
95252236e jme: JMicron Giga... |
500 501 502 503 |
break; default: break; } |
95252236e jme: JMicron Giga... |
504 505 506 |
if (phylink & PHY_LINK_DUPLEX) { jwrite32(jme, JME_TXMCS, TXMCS_DEFAULT); |
3903c0235 jme: Fix hardware... |
507 |
jwrite32(jme, JME_TXTRHD, TXTRHD_FULLDUPLEX); |
854a2e7c3 jme: Safer MAC pr... |
508 |
jme->reg_ghc |= GHC_DPX; |
95252236e jme: JMicron Giga... |
509 510 511 512 513 |
} else { jwrite32(jme, JME_TXMCS, TXMCS_DEFAULT | TXMCS_BACKOFF | TXMCS_CARRIERSENSE | TXMCS_COLLISION); |
3903c0235 jme: Fix hardware... |
514 |
jwrite32(jme, JME_TXTRHD, TXTRHD_HALFDUPLEX); |
95252236e jme: JMicron Giga... |
515 |
} |
a821ebe58 jme: Added half-d... |
516 |
|
854a2e7c3 jme: Safer MAC pr... |
517 |
jwrite32(jme, JME_GHC, jme->reg_ghc); |
a821ebe58 jme: Added half-d... |
518 |
if (is_buggy250(jme->pdev->device, jme->chiprev)) { |
854a2e7c3 jme: Safer MAC pr... |
519 520 |
jme->reg_gpreg1 &= ~(GPREG1_HALFMODEPATCH | GPREG1_RSSPATCH); |
a821ebe58 jme: Added half-d... |
521 |
if (!(phylink & PHY_LINK_DUPLEX)) |
854a2e7c3 jme: Safer MAC pr... |
522 |
jme->reg_gpreg1 |= GPREG1_HALFMODEPATCH; |
a821ebe58 jme: Added half-d... |
523 524 |
switch (phylink & PHY_LINK_SPEED_MASK) { case PHY_LINK_SPEED_10M: |
517545723 jme: Rename phyfi... |
525 |
jme_set_phyfifo_8level(jme); |
854a2e7c3 jme: Safer MAC pr... |
526 |
jme->reg_gpreg1 |= GPREG1_RSSPATCH; |
a821ebe58 jme: Added half-d... |
527 528 |
break; case PHY_LINK_SPEED_100M: |
517545723 jme: Rename phyfi... |
529 |
jme_set_phyfifo_5level(jme); |
854a2e7c3 jme: Safer MAC pr... |
530 |
jme->reg_gpreg1 |= GPREG1_RSSPATCH; |
a821ebe58 jme: Added half-d... |
531 532 |
break; case PHY_LINK_SPEED_1000M: |
517545723 jme: Rename phyfi... |
533 |
jme_set_phyfifo_8level(jme); |
a821ebe58 jme: Added half-d... |
534 535 536 537 538 |
break; default: break; } } |
854a2e7c3 jme: Safer MAC pr... |
539 |
jwrite32(jme, JME_GPREG1, jme->reg_gpreg1); |
95252236e jme: JMicron Giga... |
540 |
|
4f40bf468 jme: GHC register... |
541 542 543 544 545 546 |
strcat(linkmsg, (phylink & PHY_LINK_DUPLEX) ? "Full-Duplex, " : "Half-Duplex, "); strcat(linkmsg, (phylink & PHY_LINK_MDI_STAT) ? "MDI-X" : "MDI"); |
49d70c485 drivers/net/jme: ... |
547 548 |
netif_info(jme, link, jme->dev, "Link is up at %s ", linkmsg); |
95252236e jme: JMicron Giga... |
549 550 551 552 |
netif_carrier_on(netdev); } else { if (testonly) goto out; |
49d70c485 drivers/net/jme: ... |
553 554 |
netif_info(jme, link, jme->dev, "Link is down "); |
95252236e jme: JMicron Giga... |
555 556 557 558 559 560 561 562 563 564 565 566 567 568 569 570 571 |
jme->phylink = 0; netif_carrier_off(netdev); } out: return rc; } static int jme_setup_tx_resources(struct jme_adapter *jme) { struct jme_ring *txring = &(jme->txring[0]); txring->alloc = dma_alloc_coherent(&(jme->pdev->dev), TX_RING_ALLOC_SIZE(jme->tx_ring_size), &(txring->dmaalloc), GFP_ATOMIC); |
47bd10d14 jme: Change bufin... |
572 573 |
if (!txring->alloc) goto err_set_null; |
95252236e jme: JMicron Giga... |
574 575 576 577 578 579 580 581 582 583 |
/* * 16 Bytes align */ txring->desc = (void *)ALIGN((unsigned long)(txring->alloc), RING_DESC_ALIGN); txring->dma = ALIGN(txring->dmaalloc, RING_DESC_ALIGN); txring->next_to_use = 0; atomic_set(&txring->next_to_clean, 0); atomic_set(&txring->nr_free, jme->tx_ring_size); |
47bd10d14 jme: Change bufin... |
584 585 586 587 |
txring->bufinf = kmalloc(sizeof(struct jme_buffer_info) * jme->tx_ring_size, GFP_ATOMIC); if (unlikely(!(txring->bufinf))) goto err_free_txring; |
95252236e jme: JMicron Giga... |
588 589 590 591 592 593 594 595 |
/* * Initialize Transmit Descriptors */ memset(txring->alloc, 0, TX_RING_ALLOC_SIZE(jme->tx_ring_size)); memset(txring->bufinf, 0, sizeof(struct jme_buffer_info) * jme->tx_ring_size); return 0; |
47bd10d14 jme: Change bufin... |
596 597 598 599 600 601 602 603 604 605 606 607 608 609 |
err_free_txring: dma_free_coherent(&(jme->pdev->dev), TX_RING_ALLOC_SIZE(jme->tx_ring_size), txring->alloc, txring->dmaalloc); err_set_null: txring->desc = NULL; txring->dmaalloc = 0; txring->dma = 0; txring->bufinf = NULL; return -ENOMEM; |
95252236e jme: JMicron Giga... |
610 611 612 613 614 615 616 |
} static void jme_free_tx_resources(struct jme_adapter *jme) { int i; struct jme_ring *txring = &(jme->txring[0]); |
eacf69a15 jme: Some minor c... |
617 |
struct jme_buffer_info *txbi; |
95252236e jme: JMicron Giga... |
618 619 |
if (txring->alloc) { |
47bd10d14 jme: Change bufin... |
620 621 622 623 624 625 626 627 628 629 630 |
if (txring->bufinf) { for (i = 0 ; i < jme->tx_ring_size ; ++i) { txbi = txring->bufinf + i; if (txbi->skb) { dev_kfree_skb(txbi->skb); txbi->skb = NULL; } txbi->mapping = 0; txbi->len = 0; txbi->nr_desc = 0; txbi->start_xmit = 0; |
95252236e jme: JMicron Giga... |
631 |
} |
47bd10d14 jme: Change bufin... |
632 |
kfree(txring->bufinf); |
95252236e jme: JMicron Giga... |
633 634 635 636 637 638 639 640 641 642 643 |
} dma_free_coherent(&(jme->pdev->dev), TX_RING_ALLOC_SIZE(jme->tx_ring_size), txring->alloc, txring->dmaalloc); txring->alloc = NULL; txring->desc = NULL; txring->dmaalloc = 0; txring->dma = 0; |
47bd10d14 jme: Change bufin... |
644 |
txring->bufinf = NULL; |
95252236e jme: JMicron Giga... |
645 646 647 648 |
} txring->next_to_use = 0; atomic_set(&txring->next_to_clean, 0); atomic_set(&txring->nr_free, 0); |
95252236e jme: JMicron Giga... |
649 650 651 652 653 654 655 656 657 658 659 660 661 662 663 664 665 666 667 668 669 670 671 672 673 674 675 |
} static inline void jme_enable_tx_engine(struct jme_adapter *jme) { /* * Select Queue 0 */ jwrite32(jme, JME_TXCS, TXCS_DEFAULT | TXCS_SELECT_QUEUE0); wmb(); /* * Setup TX Queue 0 DMA Bass Address */ jwrite32(jme, JME_TXDBA_LO, (__u64)jme->txring[0].dma & 0xFFFFFFFFUL); jwrite32(jme, JME_TXDBA_HI, (__u64)(jme->txring[0].dma) >> 32); jwrite32(jme, JME_TXNDA, (__u64)jme->txring[0].dma & 0xFFFFFFFFUL); /* * Setup TX Descptor Count */ jwrite32(jme, JME_TXQDC, jme->tx_ring_size); /* * Enable TX Engine */ wmb(); |
854a2e7c3 jme: Safer MAC pr... |
676 |
jwrite32f(jme, JME_TXCS, jme->reg_txcs | |
95252236e jme: JMicron Giga... |
677 678 |
TXCS_SELECT_QUEUE0 | TXCS_ENABLE); |
854a2e7c3 jme: Safer MAC pr... |
679 680 681 682 |
/* * Start clock for TX MAC Processor */ jme_mac_txclk_on(jme); |
95252236e jme: JMicron Giga... |
683 684 685 686 687 688 689 690 691 692 693 694 695 696 697 698 699 700 701 702 703 704 705 706 707 708 709 710 711 712 713 714 715 |
} static inline void jme_restart_tx_engine(struct jme_adapter *jme) { /* * Restart TX Engine */ jwrite32(jme, JME_TXCS, jme->reg_txcs | TXCS_SELECT_QUEUE0 | TXCS_ENABLE); } static inline void jme_disable_tx_engine(struct jme_adapter *jme) { int i; u32 val; /* * Disable TX Engine */ jwrite32(jme, JME_TXCS, jme->reg_txcs | TXCS_SELECT_QUEUE0); wmb(); val = jread32(jme, JME_TXCS); for (i = JME_TX_DISABLE_TIMEOUT ; (val & TXCS_ENABLE) && i > 0 ; --i) { mdelay(1); val = jread32(jme, JME_TXCS); rmb(); } if (!i) |
49d70c485 drivers/net/jme: ... |
716 717 |
pr_err("Disable TX engine timeout "); |
854a2e7c3 jme: Safer MAC pr... |
718 719 720 721 722 |
/* * Stop clock for TX MAC Processor */ jme_mac_txclk_off(jme); |
95252236e jme: JMicron Giga... |
723 724 725 726 727 |
} static void jme_set_clean_rxdesc(struct jme_adapter *jme, int i) { |
eacf69a15 jme: Some minor c... |
728 |
struct jme_ring *rxring = &(jme->rxring[0]); |
95252236e jme: JMicron Giga... |
729 730 731 732 733 734 735 736 737 738 739 740 741 742 743 744 745 746 747 748 749 750 751 |
register struct rxdesc *rxdesc = rxring->desc; struct jme_buffer_info *rxbi = rxring->bufinf; rxdesc += i; rxbi += i; rxdesc->dw[0] = 0; rxdesc->dw[1] = 0; rxdesc->desc1.bufaddrh = cpu_to_le32((__u64)rxbi->mapping >> 32); rxdesc->desc1.bufaddrl = cpu_to_le32( (__u64)rxbi->mapping & 0xFFFFFFFFUL); rxdesc->desc1.datalen = cpu_to_le16(rxbi->len); if (jme->dev->features & NETIF_F_HIGHDMA) rxdesc->desc1.flags = RXFLAG_64BIT; wmb(); rxdesc->desc1.flags |= RXFLAG_OWN | RXFLAG_INT; } static int jme_make_new_rx_buf(struct jme_adapter *jme, int i) { struct jme_ring *rxring = &(jme->rxring[0]); struct jme_buffer_info *rxbi = rxring->bufinf + i; struct sk_buff *skb; |
94c5b41b3 jme: Fix unmap er... |
752 |
dma_addr_t mapping; |
95252236e jme: JMicron Giga... |
753 754 755 756 757 |
skb = netdev_alloc_skb(jme->dev, jme->dev->mtu + RX_EXTRA_LEN); if (unlikely(!skb)) return -ENOMEM; |
94c5b41b3 jme: Fix unmap er... |
758 759 760 761 762 763 764 765 766 767 768 |
mapping = pci_map_page(jme->pdev, virt_to_page(skb->data), offset_in_page(skb->data), skb_tailroom(skb), PCI_DMA_FROMDEVICE); if (unlikely(pci_dma_mapping_error(jme->pdev, mapping))) { dev_kfree_skb(skb); return -ENOMEM; } if (likely(rxbi->mapping)) pci_unmap_page(jme->pdev, rxbi->mapping, rxbi->len, PCI_DMA_FROMDEVICE); |
95252236e jme: JMicron Giga... |
769 770 |
rxbi->skb = skb; rxbi->len = skb_tailroom(skb); |
94c5b41b3 jme: Fix unmap er... |
771 |
rxbi->mapping = mapping; |
95252236e jme: JMicron Giga... |
772 773 774 775 776 777 778 779 780 781 782 783 784 785 786 787 788 789 790 791 792 793 794 795 796 797 798 799 800 |
return 0; } static void jme_free_rx_buf(struct jme_adapter *jme, int i) { struct jme_ring *rxring = &(jme->rxring[0]); struct jme_buffer_info *rxbi = rxring->bufinf; rxbi += i; if (rxbi->skb) { pci_unmap_page(jme->pdev, rxbi->mapping, rxbi->len, PCI_DMA_FROMDEVICE); dev_kfree_skb(rxbi->skb); rxbi->skb = NULL; rxbi->mapping = 0; rxbi->len = 0; } } static void jme_free_rx_resources(struct jme_adapter *jme) { int i; struct jme_ring *rxring = &(jme->rxring[0]); if (rxring->alloc) { |
47bd10d14 jme: Change bufin... |
801 802 803 804 805 |
if (rxring->bufinf) { for (i = 0 ; i < jme->rx_ring_size ; ++i) jme_free_rx_buf(jme, i); kfree(rxring->bufinf); } |
95252236e jme: JMicron Giga... |
806 807 808 809 810 811 812 813 814 |
dma_free_coherent(&(jme->pdev->dev), RX_RING_ALLOC_SIZE(jme->rx_ring_size), rxring->alloc, rxring->dmaalloc); rxring->alloc = NULL; rxring->desc = NULL; rxring->dmaalloc = 0; rxring->dma = 0; |
47bd10d14 jme: Change bufin... |
815 |
rxring->bufinf = NULL; |
95252236e jme: JMicron Giga... |
816 817 818 819 820 821 822 823 824 825 826 827 828 829 830 |
} rxring->next_to_use = 0; atomic_set(&rxring->next_to_clean, 0); } static int jme_setup_rx_resources(struct jme_adapter *jme) { int i; struct jme_ring *rxring = &(jme->rxring[0]); rxring->alloc = dma_alloc_coherent(&(jme->pdev->dev), RX_RING_ALLOC_SIZE(jme->rx_ring_size), &(rxring->dmaalloc), GFP_ATOMIC); |
47bd10d14 jme: Change bufin... |
831 832 |
if (!rxring->alloc) goto err_set_null; |
95252236e jme: JMicron Giga... |
833 834 835 836 837 838 839 840 841 |
/* * 16 Bytes align */ rxring->desc = (void *)ALIGN((unsigned long)(rxring->alloc), RING_DESC_ALIGN); rxring->dma = ALIGN(rxring->dmaalloc, RING_DESC_ALIGN); rxring->next_to_use = 0; atomic_set(&rxring->next_to_clean, 0); |
47bd10d14 jme: Change bufin... |
842 843 844 845 |
rxring->bufinf = kmalloc(sizeof(struct jme_buffer_info) * jme->rx_ring_size, GFP_ATOMIC); if (unlikely(!(rxring->bufinf))) goto err_free_rxring; |
95252236e jme: JMicron Giga... |
846 847 848 |
/* * Initiallize Receive Descriptors */ |
47bd10d14 jme: Change bufin... |
849 850 |
memset(rxring->bufinf, 0, sizeof(struct jme_buffer_info) * jme->rx_ring_size); |
95252236e jme: JMicron Giga... |
851 852 853 854 855 856 857 858 859 860 |
for (i = 0 ; i < jme->rx_ring_size ; ++i) { if (unlikely(jme_make_new_rx_buf(jme, i))) { jme_free_rx_resources(jme); return -ENOMEM; } jme_set_clean_rxdesc(jme, i); } return 0; |
47bd10d14 jme: Change bufin... |
861 862 863 864 865 866 867 868 869 870 871 872 873 |
err_free_rxring: dma_free_coherent(&(jme->pdev->dev), RX_RING_ALLOC_SIZE(jme->rx_ring_size), rxring->alloc, rxring->dmaalloc); err_set_null: rxring->desc = NULL; rxring->dmaalloc = 0; rxring->dma = 0; rxring->bufinf = NULL; return -ENOMEM; |
95252236e jme: JMicron Giga... |
874 875 876 877 878 879 880 881 882 883 884 885 886 887 888 |
} static inline void jme_enable_rx_engine(struct jme_adapter *jme) { /* * Select Queue 0 */ jwrite32(jme, JME_RXCS, jme->reg_rxcs | RXCS_QUEUESEL_Q0); wmb(); /* * Setup RX DMA Bass Address */ |
eacf69a15 jme: Some minor c... |
889 |
jwrite32(jme, JME_RXDBA_LO, (__u64)(jme->rxring[0].dma) & 0xFFFFFFFFUL); |
95252236e jme: JMicron Giga... |
890 |
jwrite32(jme, JME_RXDBA_HI, (__u64)(jme->rxring[0].dma) >> 32); |
eacf69a15 jme: Some minor c... |
891 |
jwrite32(jme, JME_RXNDA, (__u64)(jme->rxring[0].dma) & 0xFFFFFFFFUL); |
95252236e jme: JMicron Giga... |
892 893 894 895 896 897 898 899 900 |
/* * Setup RX Descriptor Count */ jwrite32(jme, JME_RXQDC, jme->rx_ring_size); /* * Setup Unicast Filter */ |
8b53abae5 jme: Refill recei... |
901 |
jme_set_unicastaddr(jme->dev); |
95252236e jme: JMicron Giga... |
902 903 904 905 906 907 |
jme_set_multi(jme->dev); /* * Enable RX Engine */ wmb(); |
854a2e7c3 jme: Safer MAC pr... |
908 |
jwrite32f(jme, JME_RXCS, jme->reg_rxcs | |
95252236e jme: JMicron Giga... |
909 910 911 |
RXCS_QUEUESEL_Q0 | RXCS_ENABLE | RXCS_QST); |
854a2e7c3 jme: Safer MAC pr... |
912 913 914 915 916 |
/* * Start clock for RX MAC Processor */ jme_mac_rxclk_on(jme); |
95252236e jme: JMicron Giga... |
917 918 919 920 921 922 923 924 925 926 927 928 929 930 931 932 933 934 935 936 937 938 939 940 941 942 943 944 945 946 947 948 949 950 |
} static inline void jme_restart_rx_engine(struct jme_adapter *jme) { /* * Start RX Engine */ jwrite32(jme, JME_RXCS, jme->reg_rxcs | RXCS_QUEUESEL_Q0 | RXCS_ENABLE | RXCS_QST); } static inline void jme_disable_rx_engine(struct jme_adapter *jme) { int i; u32 val; /* * Disable RX Engine */ jwrite32(jme, JME_RXCS, jme->reg_rxcs); wmb(); val = jread32(jme, JME_RXCS); for (i = JME_RX_DISABLE_TIMEOUT ; (val & RXCS_ENABLE) && i > 0 ; --i) { mdelay(1); val = jread32(jme, JME_RXCS); rmb(); } if (!i) |
49d70c485 drivers/net/jme: ... |
951 952 |
pr_err("Disable RX engine timeout "); |
95252236e jme: JMicron Giga... |
953 |
|
854a2e7c3 jme: Safer MAC pr... |
954 955 956 957 |
/* * Stop clock for RX MAC Processor */ jme_mac_rxclk_off(jme); |
95252236e jme: JMicron Giga... |
958 |
} |
c00cd8264 jme: Don't show U... |
959 960 961 962 963 964 965 966 967 968 969 970 971 972 973 974 975 976 977 978 979 980 981 982 983 |
static u16 jme_udpsum(struct sk_buff *skb) { u16 csum = 0xFFFFu; if (skb->len < (ETH_HLEN + sizeof(struct iphdr))) return csum; if (skb->protocol != htons(ETH_P_IP)) return csum; skb_set_network_header(skb, ETH_HLEN); if ((ip_hdr(skb)->protocol != IPPROTO_UDP) || (skb->len < (ETH_HLEN + (ip_hdr(skb)->ihl << 2) + sizeof(struct udphdr)))) { skb_reset_network_header(skb); return csum; } skb_set_transport_header(skb, ETH_HLEN + (ip_hdr(skb)->ihl << 2)); csum = udp_hdr(skb)->check; skb_reset_transport_header(skb); skb_reset_network_header(skb); return csum; } |
95252236e jme: JMicron Giga... |
984 |
static int |
c00cd8264 jme: Don't show U... |
985 |
jme_rxsum_ok(struct jme_adapter *jme, u16 flags, struct sk_buff *skb) |
95252236e jme: JMicron Giga... |
986 987 988 |
{ if (!(flags & (RXWBFLAG_TCPON | RXWBFLAG_UDPON | RXWBFLAG_IPV4))) return false; |
ce7d70af2 jme: Tuning rxsum... |
989 990 991 |
if (unlikely((flags & (RXWBFLAG_MF | RXWBFLAG_TCPON | RXWBFLAG_TCPCS)) == RXWBFLAG_TCPON)) { if (flags & RXWBFLAG_IPV4) |
f8502ce4f drivers/net/jme: ... |
992 993 |
netif_err(jme, rx_err, jme->dev, "TCP Checksum error "); |
ce7d70af2 jme: Tuning rxsum... |
994 |
return false; |
95252236e jme: JMicron Giga... |
995 |
} |
ce7d70af2 jme: Tuning rxsum... |
996 |
if (unlikely((flags & (RXWBFLAG_MF | RXWBFLAG_UDPON | RXWBFLAG_UDPCS)) |
c00cd8264 jme: Don't show U... |
997 |
== RXWBFLAG_UDPON) && jme_udpsum(skb)) { |
ce7d70af2 jme: Tuning rxsum... |
998 |
if (flags & RXWBFLAG_IPV4) |
49d70c485 drivers/net/jme: ... |
999 1000 |
netif_err(jme, rx_err, jme->dev, "UDP Checksum error "); |
ce7d70af2 jme: Tuning rxsum... |
1001 |
return false; |
95252236e jme: JMicron Giga... |
1002 |
} |
ce7d70af2 jme: Tuning rxsum... |
1003 1004 |
if (unlikely((flags & (RXWBFLAG_IPV4 | RXWBFLAG_IPCS)) == RXWBFLAG_IPV4)) { |
49d70c485 drivers/net/jme: ... |
1005 1006 |
netif_err(jme, rx_err, jme->dev, "IPv4 Checksum error "); |
ce7d70af2 jme: Tuning rxsum... |
1007 |
return false; |
95252236e jme: JMicron Giga... |
1008 1009 1010 |
} return true; |
95252236e jme: JMicron Giga... |
1011 1012 1013 1014 1015 1016 1017 1018 1019 1020 1021 1022 1023 1024 1025 1026 1027 1028 1029 1030 1031 1032 1033 1034 1035 1036 1037 1038 1039 1040 1041 1042 1043 1044 |
} static void jme_alloc_and_feed_skb(struct jme_adapter *jme, int idx) { struct jme_ring *rxring = &(jme->rxring[0]); struct rxdesc *rxdesc = rxring->desc; struct jme_buffer_info *rxbi = rxring->bufinf; struct sk_buff *skb; int framesize; rxdesc += idx; rxbi += idx; skb = rxbi->skb; pci_dma_sync_single_for_cpu(jme->pdev, rxbi->mapping, rxbi->len, PCI_DMA_FROMDEVICE); if (unlikely(jme_make_new_rx_buf(jme, idx))) { pci_dma_sync_single_for_device(jme->pdev, rxbi->mapping, rxbi->len, PCI_DMA_FROMDEVICE); ++(NET_STAT(jme).rx_dropped); } else { framesize = le16_to_cpu(rxdesc->descwb.framesize) - RX_PREPAD_SIZE; skb_reserve(skb, RX_PREPAD_SIZE); skb_put(skb, framesize); skb->protocol = eth_type_trans(skb, jme->dev); |
c00cd8264 jme: Don't show U... |
1045 |
if (jme_rxsum_ok(jme, le16_to_cpu(rxdesc->descwb.flags), skb)) |
95252236e jme: JMicron Giga... |
1046 1047 |
skb->ip_summed = CHECKSUM_UNNECESSARY; else |
bc8acf2c8 drivers/net: avoi... |
1048 |
skb_checksum_none_assert(skb); |
95252236e jme: JMicron Giga... |
1049 |
|
31c221c49 net: jme.c rxdesc... |
1050 |
if (rxdesc->descwb.flags & cpu_to_le16(RXWBFLAG_TAGON)) { |
5043f5057 jme: do vlan cleanup |
1051 |
u16 vid = le16_to_cpu(rxdesc->descwb.vlan); |
86a9bad3a net: vlan: add pr... |
1052 |
__vlan_hwaccel_put_tag(skb, htons(ETH_P_8021Q), vid); |
5043f5057 jme: do vlan cleanup |
1053 |
NET_STAT(jme).rx_bytes += 4; |
95252236e jme: JMicron Giga... |
1054 |
} |
5043f5057 jme: do vlan cleanup |
1055 |
jme->jme_rx(skb); |
95252236e jme: JMicron Giga... |
1056 |
|
31c221c49 net: jme.c rxdesc... |
1057 1058 |
if ((rxdesc->descwb.flags & cpu_to_le16(RXWBFLAG_DEST)) == cpu_to_le16(RXWBFLAG_DEST_MUL)) |
95252236e jme: JMicron Giga... |
1059 |
++(NET_STAT(jme).multicast); |
95252236e jme: JMicron Giga... |
1060 1061 1062 1063 1064 1065 1066 1067 1068 1069 1070 1071 1072 1073 1074 1075 1076 1077 1078 1079 1080 1081 1082 1083 1084 |
NET_STAT(jme).rx_bytes += framesize; ++(NET_STAT(jme).rx_packets); } jme_set_clean_rxdesc(jme, idx); } static int jme_process_receive(struct jme_adapter *jme, int limit) { struct jme_ring *rxring = &(jme->rxring[0]); struct rxdesc *rxdesc = rxring->desc; int i, j, ccnt, desccnt, mask = jme->rx_ring_mask; if (unlikely(!atomic_dec_and_test(&jme->rx_cleaning))) goto out_inc; if (unlikely(atomic_read(&jme->link_changing) != 1)) goto out_inc; if (unlikely(!netif_carrier_ok(jme->dev))) goto out_inc; i = atomic_read(&rxring->next_to_clean); |
858b9ced6 net: more timeout... |
1085 |
while (limit > 0) { |
95252236e jme: JMicron Giga... |
1086 1087 |
rxdesc = rxring->desc; rxdesc += i; |
31c221c49 net: jme.c rxdesc... |
1088 |
if ((rxdesc->descwb.flags & cpu_to_le16(RXWBFLAG_OWN)) || |
95252236e jme: JMicron Giga... |
1089 1090 |
!(rxdesc->descwb.desccnt & RXWBDCNT_WBCPL)) goto out; |
858b9ced6 net: more timeout... |
1091 |
--limit; |
95252236e jme: JMicron Giga... |
1092 |
|
ea192aa89 jme: Prevent poss... |
1093 |
rmb(); |
95252236e jme: JMicron Giga... |
1094 1095 1096 1097 1098 1099 1100 1101 1102 1103 1104 1105 1106 1107 1108 1109 1110 1111 1112 1113 1114 1115 1116 1117 1118 1119 1120 1121 1122 1123 1124 1125 1126 1127 1128 1129 1130 1131 1132 1133 1134 1135 1136 1137 1138 1139 1140 1141 1142 1143 1144 1145 1146 1147 1148 1149 1150 1151 1152 1153 1154 |
desccnt = rxdesc->descwb.desccnt & RXWBDCNT_DCNT; if (unlikely(desccnt > 1 || rxdesc->descwb.errstat & RXWBERR_ALLERR)) { if (rxdesc->descwb.errstat & RXWBERR_CRCERR) ++(NET_STAT(jme).rx_crc_errors); else if (rxdesc->descwb.errstat & RXWBERR_OVERUN) ++(NET_STAT(jme).rx_fifo_errors); else ++(NET_STAT(jme).rx_errors); if (desccnt > 1) limit -= desccnt - 1; for (j = i, ccnt = desccnt ; ccnt-- ; ) { jme_set_clean_rxdesc(jme, j); j = (j + 1) & (mask); } } else { jme_alloc_and_feed_skb(jme, i); } i = (i + desccnt) & (mask); } out: atomic_set(&rxring->next_to_clean, i); out_inc: atomic_inc(&jme->rx_cleaning); return limit > 0 ? limit : 0; } static void jme_attempt_pcc(struct dynpcc_info *dpi, int atmp) { if (likely(atmp == dpi->cur)) { dpi->cnt = 0; return; } if (dpi->attempt == atmp) { ++(dpi->cnt); } else { dpi->attempt = atmp; dpi->cnt = 0; } } static void jme_dynamic_pcc(struct jme_adapter *jme) { register struct dynpcc_info *dpi = &(jme->dpi); if ((NET_STAT(jme).rx_bytes - dpi->last_bytes) > PCC_P3_THRESHOLD) jme_attempt_pcc(dpi, PCC_P3); |
8e95a2026 drivers/net: Move... |
1155 1156 |
else if ((NET_STAT(jme).rx_packets - dpi->last_pkts) > PCC_P2_THRESHOLD || dpi->intr_cnt > PCC_INTR_THRESHOLD) |
95252236e jme: JMicron Giga... |
1157 1158 1159 1160 1161 1162 1163 1164 1165 1166 1167 1168 1169 1170 1171 1172 1173 1174 1175 1176 1177 1178 1179 1180 1181 1182 1183 1184 1185 1186 1187 1188 1189 1190 1191 1192 1193 1194 1195 1196 1197 1198 1199 1200 1201 1202 1203 1204 1205 1206 1207 1208 1209 1210 1211 1212 1213 1214 1215 1216 1217 1218 1219 1220 1221 1222 1223 1224 1225 1226 1227 1228 1229 1230 1231 1232 1233 1234 1235 1236 1237 1238 1239 1240 1241 1242 1243 1244 1245 1246 1247 1248 1249 1250 1251 1252 1253 1254 1255 1256 1257 1258 1259 1260 1261 1262 1263 1264 1265 1266 1267 1268 1269 1270 1271 1272 1273 1274 1275 1276 1277 1278 1279 1280 1281 1282 1283 1284 1285 1286 1287 1288 1289 1290 |
jme_attempt_pcc(dpi, PCC_P2); else jme_attempt_pcc(dpi, PCC_P1); if (unlikely(dpi->attempt != dpi->cur && dpi->cnt > 5)) { if (dpi->attempt < dpi->cur) tasklet_schedule(&jme->rxclean_task); jme_set_rx_pcc(jme, dpi->attempt); dpi->cur = dpi->attempt; dpi->cnt = 0; } } static void jme_start_pcc_timer(struct jme_adapter *jme) { struct dynpcc_info *dpi = &(jme->dpi); dpi->last_bytes = NET_STAT(jme).rx_bytes; dpi->last_pkts = NET_STAT(jme).rx_packets; dpi->intr_cnt = 0; jwrite32(jme, JME_TMCSR, TMCSR_EN | ((0xFFFFFF - PCC_INTERVAL_US) & TMCSR_CNT)); } static inline void jme_stop_pcc_timer(struct jme_adapter *jme) { jwrite32(jme, JME_TMCSR, 0); } static void jme_shutdown_nic(struct jme_adapter *jme) { u32 phylink; phylink = jme_linkstat_from_phy(jme); if (!(phylink & PHY_LINK_UP)) { /* * Disable all interrupt before issue timer */ jme_stop_irq(jme); jwrite32(jme, JME_TIMER2, TMCSR_EN | 0xFFFFFE); } } static void jme_pcc_tasklet(unsigned long arg) { struct jme_adapter *jme = (struct jme_adapter *)arg; struct net_device *netdev = jme->dev; if (unlikely(test_bit(JME_FLAG_SHUTDOWN, &jme->flags))) { jme_shutdown_nic(jme); return; } if (unlikely(!netif_carrier_ok(netdev) || (atomic_read(&jme->link_changing) != 1) )) { jme_stop_pcc_timer(jme); return; } if (!(test_bit(JME_FLAG_POLL, &jme->flags))) jme_dynamic_pcc(jme); jme_start_pcc_timer(jme); } static inline void jme_polling_mode(struct jme_adapter *jme) { jme_set_rx_pcc(jme, PCC_OFF); } static inline void jme_interrupt_mode(struct jme_adapter *jme) { jme_set_rx_pcc(jme, PCC_P1); } static inline int jme_pseudo_hotplug_enabled(struct jme_adapter *jme) { u32 apmc; apmc = jread32(jme, JME_APMC); return apmc & JME_APMC_PSEUDO_HP_EN; } static void jme_start_shutdown_timer(struct jme_adapter *jme) { u32 apmc; apmc = jread32(jme, JME_APMC) | JME_APMC_PCIE_SD_EN; apmc &= ~JME_APMC_EPIEN_CTRL; if (!no_extplug) { jwrite32f(jme, JME_APMC, apmc | JME_APMC_EPIEN_CTRL_EN); wmb(); } jwrite32f(jme, JME_APMC, apmc); jwrite32f(jme, JME_TIMER2, 0); set_bit(JME_FLAG_SHUTDOWN, &jme->flags); jwrite32(jme, JME_TMCSR, TMCSR_EN | ((0xFFFFFF - APMC_PHP_SHUTDOWN_DELAY) & TMCSR_CNT)); } static void jme_stop_shutdown_timer(struct jme_adapter *jme) { u32 apmc; jwrite32f(jme, JME_TMCSR, 0); jwrite32f(jme, JME_TIMER2, 0); clear_bit(JME_FLAG_SHUTDOWN, &jme->flags); apmc = jread32(jme, JME_APMC); apmc &= ~(JME_APMC_PCIE_SD_EN | JME_APMC_EPIEN_CTRL); jwrite32f(jme, JME_APMC, apmc | JME_APMC_EPIEN_CTRL_DIS); wmb(); jwrite32f(jme, JME_APMC, apmc); } static void jme_link_change_tasklet(unsigned long arg) { struct jme_adapter *jme = (struct jme_adapter *)arg; struct net_device *netdev = jme->dev; int rc; while (!atomic_dec_and_test(&jme->link_changing)) { atomic_inc(&jme->link_changing); |
49d70c485 drivers/net/jme: ... |
1291 1292 |
netif_info(jme, intr, jme->dev, "Get link change lock failed "); |
95252236e jme: JMicron Giga... |
1293 |
while (atomic_read(&jme->link_changing) != 1) |
49d70c485 drivers/net/jme: ... |
1294 1295 |
netif_info(jme, intr, jme->dev, "Waiting link change lock "); |
95252236e jme: JMicron Giga... |
1296 1297 1298 1299 1300 1301 1302 1303 1304 1305 1306 1307 1308 1309 1310 1311 |
} if (jme_check_link(netdev, 1) && jme->old_mtu == netdev->mtu) goto out; jme->old_mtu = netdev->mtu; netif_stop_queue(netdev); if (jme_pseudo_hotplug_enabled(jme)) jme_stop_shutdown_timer(jme); jme_stop_pcc_timer(jme); tasklet_disable(&jme->txclean_task); tasklet_disable(&jme->rxclean_task); tasklet_disable(&jme->rxempty_task); if (netif_carrier_ok(netdev)) { |
95252236e jme: JMicron Giga... |
1312 1313 1314 1315 1316 1317 1318 1319 1320 1321 1322 1323 1324 1325 1326 1327 |
jme_disable_rx_engine(jme); jme_disable_tx_engine(jme); jme_reset_mac_processor(jme); jme_free_rx_resources(jme); jme_free_tx_resources(jme); if (test_bit(JME_FLAG_POLL, &jme->flags)) jme_polling_mode(jme); netif_carrier_off(netdev); } jme_check_link(netdev, 0); if (netif_carrier_ok(netdev)) { rc = jme_setup_rx_resources(jme); if (rc) { |
49d70c485 drivers/net/jme: ... |
1328 1329 |
pr_err("Allocating resources for RX error, Device STOPPED! "); |
95252236e jme: JMicron Giga... |
1330 1331 1332 1333 1334 |
goto out_enable_tasklet; } rc = jme_setup_tx_resources(jme); if (rc) { |
49d70c485 drivers/net/jme: ... |
1335 1336 |
pr_err("Allocating resources for TX error, Device STOPPED! "); |
95252236e jme: JMicron Giga... |
1337 1338 1339 1340 1341 1342 1343 1344 1345 1346 1347 1348 1349 1350 1351 1352 1353 1354 1355 1356 1357 1358 1359 1360 1361 1362 1363 1364 1365 1366 1367 1368 1369 1370 1371 1372 1373 1374 1375 1376 1377 1378 1379 |
goto err_out_free_rx_resources; } jme_enable_rx_engine(jme); jme_enable_tx_engine(jme); netif_start_queue(netdev); if (test_bit(JME_FLAG_POLL, &jme->flags)) jme_interrupt_mode(jme); jme_start_pcc_timer(jme); } else if (jme_pseudo_hotplug_enabled(jme)) { jme_start_shutdown_timer(jme); } goto out_enable_tasklet; err_out_free_rx_resources: jme_free_rx_resources(jme); out_enable_tasklet: tasklet_enable(&jme->txclean_task); tasklet_hi_enable(&jme->rxclean_task); tasklet_hi_enable(&jme->rxempty_task); out: atomic_inc(&jme->link_changing); } static void jme_rx_clean_tasklet(unsigned long arg) { struct jme_adapter *jme = (struct jme_adapter *)arg; struct dynpcc_info *dpi = &(jme->dpi); jme_process_receive(jme, jme->rx_ring_size); ++(dpi->intr_cnt); } static int jme_poll(JME_NAPI_HOLDER(holder), JME_NAPI_WEIGHT(budget)) { struct jme_adapter *jme = jme_napi_priv(holder); |
95252236e jme: JMicron Giga... |
1380 1381 1382 1383 1384 1385 1386 1387 1388 1389 1390 1391 1392 1393 1394 1395 1396 1397 1398 1399 1400 1401 1402 1403 1404 1405 1406 1407 1408 1409 |
int rest; rest = jme_process_receive(jme, JME_NAPI_WEIGHT_VAL(budget)); while (atomic_read(&jme->rx_empty) > 0) { atomic_dec(&jme->rx_empty); ++(NET_STAT(jme).rx_dropped); jme_restart_rx_engine(jme); } atomic_inc(&jme->rx_empty); if (rest) { JME_RX_COMPLETE(netdev, holder); jme_interrupt_mode(jme); } JME_NAPI_WEIGHT_SET(budget, rest); return JME_NAPI_WEIGHT_VAL(budget) - rest; } static void jme_rx_empty_tasklet(unsigned long arg) { struct jme_adapter *jme = (struct jme_adapter *)arg; if (unlikely(atomic_read(&jme->link_changing) != 1)) return; if (unlikely(!netif_carrier_ok(jme->dev))) return; |
f8502ce4f drivers/net/jme: ... |
1410 1411 |
netif_info(jme, rx_status, jme->dev, "RX Queue Full! "); |
95252236e jme: JMicron Giga... |
1412 1413 1414 1415 1416 1417 1418 1419 1420 1421 1422 1423 1424 1425 |
jme_rx_clean_tasklet(arg); while (atomic_read(&jme->rx_empty) > 0) { atomic_dec(&jme->rx_empty); ++(NET_STAT(jme).rx_dropped); jme_restart_rx_engine(jme); } atomic_inc(&jme->rx_empty); } static void jme_wake_queue_if_stopped(struct jme_adapter *jme) { |
eacf69a15 jme: Some minor c... |
1426 |
struct jme_ring *txring = &(jme->txring[0]); |
95252236e jme: JMicron Giga... |
1427 1428 1429 1430 |
smp_wmb(); if (unlikely(netif_queue_stopped(jme->dev) && atomic_read(&txring->nr_free) >= (jme->tx_wake_threshold))) { |
49d70c485 drivers/net/jme: ... |
1431 1432 |
netif_info(jme, tx_done, jme->dev, "TX Queue Waked "); |
95252236e jme: JMicron Giga... |
1433 1434 1435 1436 1437 1438 1439 1440 1441 1442 1443 1444 1445 |
netif_wake_queue(jme->dev); } } static void jme_tx_clean_tasklet(unsigned long arg) { struct jme_adapter *jme = (struct jme_adapter *)arg; struct jme_ring *txring = &(jme->txring[0]); struct txdesc *txdesc = txring->desc; struct jme_buffer_info *txbi = txring->bufinf, *ctxbi, *ttxbi; int i, j, cnt = 0, max, err, mask; |
49d70c485 drivers/net/jme: ... |
1446 1447 |
tx_dbg(jme, "Into txclean "); |
95252236e jme: JMicron Giga... |
1448 1449 1450 1451 1452 1453 1454 1455 1456 1457 1458 1459 1460 1461 1462 1463 1464 1465 1466 1467 1468 1469 |
if (unlikely(!atomic_dec_and_test(&jme->tx_cleaning))) goto out; if (unlikely(atomic_read(&jme->link_changing) != 1)) goto out; if (unlikely(!netif_carrier_ok(jme->dev))) goto out; max = jme->tx_ring_size - atomic_read(&txring->nr_free); mask = jme->tx_ring_mask; for (i = atomic_read(&txring->next_to_clean) ; cnt < max ; ) { ctxbi = txbi + i; if (likely(ctxbi->skb && !(txdesc[i].descwb.flags & TXWBFLAG_OWN))) { tx_dbg(jme, "txclean: %d+%d@%lu ", |
49d70c485 drivers/net/jme: ... |
1470 |
i, ctxbi->nr_desc, jiffies); |
95252236e jme: JMicron Giga... |
1471 1472 1473 1474 1475 1476 1477 1478 1479 1480 1481 1482 1483 1484 1485 1486 1487 1488 1489 1490 1491 1492 1493 1494 1495 1496 1497 1498 1499 1500 1501 1502 1503 1504 1505 1506 1507 1508 1509 |
err = txdesc[i].descwb.flags & TXWBFLAG_ALLERR; for (j = 1 ; j < ctxbi->nr_desc ; ++j) { ttxbi = txbi + ((i + j) & (mask)); txdesc[(i + j) & (mask)].dw[0] = 0; pci_unmap_page(jme->pdev, ttxbi->mapping, ttxbi->len, PCI_DMA_TODEVICE); ttxbi->mapping = 0; ttxbi->len = 0; } dev_kfree_skb(ctxbi->skb); cnt += ctxbi->nr_desc; if (unlikely(err)) { ++(NET_STAT(jme).tx_carrier_errors); } else { ++(NET_STAT(jme).tx_packets); NET_STAT(jme).tx_bytes += ctxbi->len; } ctxbi->skb = NULL; ctxbi->len = 0; ctxbi->start_xmit = 0; } else { break; } i = (i + ctxbi->nr_desc) & mask; ctxbi->nr_desc = 0; } |
49d70c485 drivers/net/jme: ... |
1510 1511 |
tx_dbg(jme, "txclean: done %d@%lu ", i, jiffies); |
95252236e jme: JMicron Giga... |
1512 1513 1514 1515 1516 1517 1518 1519 1520 1521 1522 1523 1524 1525 1526 1527 1528 1529 1530 1531 1532 1533 1534 1535 1536 1537 1538 1539 1540 1541 1542 1543 1544 1545 1546 1547 1548 1549 1550 1551 1552 1553 1554 1555 1556 1557 1558 1559 1560 1561 1562 1563 1564 1565 1566 1567 1568 1569 1570 1571 1572 1573 1574 1575 1576 1577 1578 1579 1580 1581 1582 1583 1584 1585 1586 1587 1588 1589 1590 1591 1592 1593 |
atomic_set(&txring->next_to_clean, i); atomic_add(cnt, &txring->nr_free); jme_wake_queue_if_stopped(jme); out: atomic_inc(&jme->tx_cleaning); } static void jme_intr_msi(struct jme_adapter *jme, u32 intrstat) { /* * Disable interrupt */ jwrite32f(jme, JME_IENC, INTR_ENABLE); if (intrstat & (INTR_LINKCH | INTR_SWINTR)) { /* * Link change event is critical * all other events are ignored */ jwrite32(jme, JME_IEVE, intrstat); tasklet_schedule(&jme->linkch_task); goto out_reenable; } if (intrstat & INTR_TMINTR) { jwrite32(jme, JME_IEVE, INTR_TMINTR); tasklet_schedule(&jme->pcc_task); } if (intrstat & (INTR_PCCTXTO | INTR_PCCTX)) { jwrite32(jme, JME_IEVE, INTR_PCCTXTO | INTR_PCCTX | INTR_TX0); tasklet_schedule(&jme->txclean_task); } if ((intrstat & (INTR_PCCRX0TO | INTR_PCCRX0 | INTR_RX0EMP))) { jwrite32(jme, JME_IEVE, (intrstat & (INTR_PCCRX0TO | INTR_PCCRX0 | INTR_RX0EMP)) | INTR_RX0); } if (test_bit(JME_FLAG_POLL, &jme->flags)) { if (intrstat & INTR_RX0EMP) atomic_inc(&jme->rx_empty); if ((intrstat & (INTR_PCCRX0TO | INTR_PCCRX0 | INTR_RX0EMP))) { if (likely(JME_RX_SCHEDULE_PREP(jme))) { jme_polling_mode(jme); JME_RX_SCHEDULE(jme); } } } else { if (intrstat & INTR_RX0EMP) { atomic_inc(&jme->rx_empty); tasklet_hi_schedule(&jme->rxempty_task); } else if (intrstat & (INTR_PCCRX0TO | INTR_PCCRX0)) { tasklet_hi_schedule(&jme->rxclean_task); } } out_reenable: /* * Re-enable interrupt */ jwrite32f(jme, JME_IENS, INTR_ENABLE); } static irqreturn_t jme_intr(int irq, void *dev_id) { struct net_device *netdev = dev_id; struct jme_adapter *jme = netdev_priv(netdev); u32 intrstat; intrstat = jread32(jme, JME_IEVE); /* * Check if it's really an interrupt for us */ |
576b5223e jme: Faulty IRQ h... |
1594 |
if (unlikely((intrstat & INTR_ENABLE) == 0)) |
95252236e jme: JMicron Giga... |
1595 1596 1597 1598 1599 1600 1601 1602 1603 1604 1605 1606 1607 1608 1609 1610 1611 1612 1613 |
return IRQ_NONE; /* * Check if the device still exist */ if (unlikely(intrstat == ~((typeof(intrstat))0))) return IRQ_NONE; jme_intr_msi(jme, intrstat); return IRQ_HANDLED; } static irqreturn_t jme_msi(int irq, void *dev_id) { struct net_device *netdev = dev_id; struct jme_adapter *jme = netdev_priv(netdev); u32 intrstat; |
d1dfa1d1d jme: Remove shado... |
1614 |
intrstat = jread32(jme, JME_IEVE); |
95252236e jme: JMicron Giga... |
1615 1616 1617 1618 1619 1620 1621 1622 1623 1624 1625 1626 1627 1628 1629 1630 1631 1632 1633 1634 1635 1636 1637 1638 1639 1640 1641 1642 1643 1644 1645 1646 1647 1648 1649 1650 1651 1652 1653 1654 1655 |
jme_intr_msi(jme, intrstat); return IRQ_HANDLED; } static void jme_reset_link(struct jme_adapter *jme) { jwrite32(jme, JME_TMCSR, TMCSR_SWIT); } static void jme_restart_an(struct jme_adapter *jme) { u32 bmcr; spin_lock_bh(&jme->phy_lock); bmcr = jme_mdio_read(jme->dev, jme->mii_if.phy_id, MII_BMCR); bmcr |= (BMCR_ANENABLE | BMCR_ANRESTART); jme_mdio_write(jme->dev, jme->mii_if.phy_id, MII_BMCR, bmcr); spin_unlock_bh(&jme->phy_lock); } static int jme_request_irq(struct jme_adapter *jme) { int rc; struct net_device *netdev = jme->dev; irq_handler_t handler = jme_intr; int irq_flags = IRQF_SHARED; if (!pci_enable_msi(jme->pdev)) { set_bit(JME_FLAG_MSI, &jme->flags); handler = jme_msi; irq_flags = 0; } rc = request_irq(jme->pdev->irq, handler, irq_flags, netdev->name, netdev); if (rc) { |
49d70c485 drivers/net/jme: ... |
1656 1657 1658 1659 1660 |
netdev_err(netdev, "Unable to request %s interrupt (return: %d) ", test_bit(JME_FLAG_MSI, &jme->flags) ? "MSI" : "INTx", rc); |
95252236e jme: JMicron Giga... |
1661 1662 1663 1664 1665 1666 1667 1668 1669 1670 1671 1672 1673 1674 1675 1676 1677 1678 1679 1680 1681 1682 |
if (test_bit(JME_FLAG_MSI, &jme->flags)) { pci_disable_msi(jme->pdev); clear_bit(JME_FLAG_MSI, &jme->flags); } } else { netdev->irq = jme->pdev->irq; } return rc; } static void jme_free_irq(struct jme_adapter *jme) { free_irq(jme->pdev->irq, jme->dev); if (test_bit(JME_FLAG_MSI, &jme->flags)) { pci_disable_msi(jme->pdev); clear_bit(JME_FLAG_MSI, &jme->flags); jme->dev->irq = jme->pdev->irq; } } |
c8a8684d5 jme: Fix PHY powe... |
1683 |
static inline void |
4872b11fd jme: PHY Power co... |
1684 1685 1686 1687 1688 1689 1690 1691 1692 1693 1694 1695 1696 1697 1698 1699 1700 1701 1702 1703 1704 1705 1706 1707 1708 1709 1710 1711 1712 1713 1714 1715 |
jme_new_phy_on(struct jme_adapter *jme) { u32 reg; reg = jread32(jme, JME_PHY_PWR); reg &= ~(PHY_PWR_DWN1SEL | PHY_PWR_DWN1SW | PHY_PWR_DWN2 | PHY_PWR_CLKSEL); jwrite32(jme, JME_PHY_PWR, reg); pci_read_config_dword(jme->pdev, PCI_PRIV_PE1, ®); reg &= ~PE1_GPREG0_PBG; reg |= PE1_GPREG0_ENBG; pci_write_config_dword(jme->pdev, PCI_PRIV_PE1, reg); } static inline void jme_new_phy_off(struct jme_adapter *jme) { u32 reg; reg = jread32(jme, JME_PHY_PWR); reg |= PHY_PWR_DWN1SEL | PHY_PWR_DWN1SW | PHY_PWR_DWN2 | PHY_PWR_CLKSEL; jwrite32(jme, JME_PHY_PWR, reg); pci_read_config_dword(jme->pdev, PCI_PRIV_PE1, ®); reg &= ~PE1_GPREG0_PBG; reg |= PE1_GPREG0_PDD3COLD; pci_write_config_dword(jme->pdev, PCI_PRIV_PE1, reg); } static inline void |
c8a8684d5 jme: Fix PHY powe... |
1716 1717 1718 1719 1720 1721 1722 |
jme_phy_on(struct jme_adapter *jme) { u32 bmcr; bmcr = jme_mdio_read(jme->dev, jme->mii_if.phy_id, MII_BMCR); bmcr &= ~BMCR_PDOWN; jme_mdio_write(jme->dev, jme->mii_if.phy_id, MII_BMCR, bmcr); |
4872b11fd jme: PHY Power co... |
1723 1724 1725 1726 1727 1728 1729 1730 1731 1732 1733 1734 1735 1736 1737 1738 |
if (new_phy_power_ctrl(jme->chip_main_rev)) jme_new_phy_on(jme); } static inline void jme_phy_off(struct jme_adapter *jme) { u32 bmcr; bmcr = jme_mdio_read(jme->dev, jme->mii_if.phy_id, MII_BMCR); bmcr |= BMCR_PDOWN; jme_mdio_write(jme->dev, jme->mii_if.phy_id, MII_BMCR, bmcr); if (new_phy_power_ctrl(jme->chip_main_rev)) jme_new_phy_off(jme); |
c8a8684d5 jme: Fix PHY powe... |
1739 |
} |
95252236e jme: JMicron Giga... |
1740 |
static int |
c4860ba2e jme: PHY configur... |
1741 1742 1743 1744 1745 1746 1747 1748 1749 1750 1751 1752 1753 1754 1755 1756 1757 1758 1759 1760 1761 1762 1763 1764 1765 1766 1767 1768 1769 1770 1771 1772 1773 1774 1775 1776 1777 1778 1779 1780 1781 1782 1783 1784 1785 1786 1787 1788 1789 1790 1791 1792 1793 1794 1795 1796 1797 1798 1799 1800 1801 1802 1803 1804 1805 1806 1807 1808 1809 1810 1811 1812 1813 1814 1815 1816 1817 1818 1819 1820 1821 1822 1823 1824 1825 1826 1827 1828 1829 1830 1831 1832 1833 1834 1835 1836 1837 1838 1839 1840 1841 1842 1843 1844 1845 1846 |
jme_phy_specreg_read(struct jme_adapter *jme, u32 specreg) { u32 phy_addr; phy_addr = JM_PHY_SPEC_REG_READ | specreg; jme_mdio_write(jme->dev, jme->mii_if.phy_id, JM_PHY_SPEC_ADDR_REG, phy_addr); return jme_mdio_read(jme->dev, jme->mii_if.phy_id, JM_PHY_SPEC_DATA_REG); } static void jme_phy_specreg_write(struct jme_adapter *jme, u32 ext_reg, u32 phy_data) { u32 phy_addr; phy_addr = JM_PHY_SPEC_REG_WRITE | ext_reg; jme_mdio_write(jme->dev, jme->mii_if.phy_id, JM_PHY_SPEC_DATA_REG, phy_data); jme_mdio_write(jme->dev, jme->mii_if.phy_id, JM_PHY_SPEC_ADDR_REG, phy_addr); } static int jme_phy_calibration(struct jme_adapter *jme) { u32 ctrl1000, phy_data; jme_phy_off(jme); jme_phy_on(jme); /* Enabel PHY test mode 1 */ ctrl1000 = jme_mdio_read(jme->dev, jme->mii_if.phy_id, MII_CTRL1000); ctrl1000 &= ~PHY_GAD_TEST_MODE_MSK; ctrl1000 |= PHY_GAD_TEST_MODE_1; jme_mdio_write(jme->dev, jme->mii_if.phy_id, MII_CTRL1000, ctrl1000); phy_data = jme_phy_specreg_read(jme, JM_PHY_EXT_COMM_2_REG); phy_data &= ~JM_PHY_EXT_COMM_2_CALI_MODE_0; phy_data |= JM_PHY_EXT_COMM_2_CALI_LATCH | JM_PHY_EXT_COMM_2_CALI_ENABLE; jme_phy_specreg_write(jme, JM_PHY_EXT_COMM_2_REG, phy_data); msleep(20); phy_data = jme_phy_specreg_read(jme, JM_PHY_EXT_COMM_2_REG); phy_data &= ~(JM_PHY_EXT_COMM_2_CALI_ENABLE | JM_PHY_EXT_COMM_2_CALI_MODE_0 | JM_PHY_EXT_COMM_2_CALI_LATCH); jme_phy_specreg_write(jme, JM_PHY_EXT_COMM_2_REG, phy_data); /* Disable PHY test mode */ ctrl1000 = jme_mdio_read(jme->dev, jme->mii_if.phy_id, MII_CTRL1000); ctrl1000 &= ~PHY_GAD_TEST_MODE_MSK; jme_mdio_write(jme->dev, jme->mii_if.phy_id, MII_CTRL1000, ctrl1000); return 0; } static int jme_phy_setEA(struct jme_adapter *jme) { u32 phy_comm0 = 0, phy_comm1 = 0; u8 nic_ctrl; pci_read_config_byte(jme->pdev, PCI_PRIV_SHARE_NICCTRL, &nic_ctrl); if ((nic_ctrl & 0x3) == JME_FLAG_PHYEA_ENABLE) return 0; switch (jme->pdev->device) { case PCI_DEVICE_ID_JMICRON_JMC250: if (((jme->chip_main_rev == 5) && ((jme->chip_sub_rev == 0) || (jme->chip_sub_rev == 1) || (jme->chip_sub_rev == 3))) || (jme->chip_main_rev >= 6)) { phy_comm0 = 0x008A; phy_comm1 = 0x4109; } if ((jme->chip_main_rev == 3) && ((jme->chip_sub_rev == 1) || (jme->chip_sub_rev == 2))) phy_comm0 = 0xE088; break; case PCI_DEVICE_ID_JMICRON_JMC260: if (((jme->chip_main_rev == 5) && ((jme->chip_sub_rev == 0) || (jme->chip_sub_rev == 1) || (jme->chip_sub_rev == 3))) || (jme->chip_main_rev >= 6)) { phy_comm0 = 0x008A; phy_comm1 = 0x4109; } if ((jme->chip_main_rev == 3) && ((jme->chip_sub_rev == 1) || (jme->chip_sub_rev == 2))) phy_comm0 = 0xE088; if ((jme->chip_main_rev == 2) && (jme->chip_sub_rev == 0)) phy_comm0 = 0x608A; if ((jme->chip_main_rev == 2) && (jme->chip_sub_rev == 2)) phy_comm0 = 0x408A; break; default: return -ENODEV; } if (phy_comm0) jme_phy_specreg_write(jme, JM_PHY_EXT_COMM_0_REG, phy_comm0); if (phy_comm1) jme_phy_specreg_write(jme, JM_PHY_EXT_COMM_1_REG, phy_comm1); return 0; } static int |
95252236e jme: JMicron Giga... |
1847 1848 1849 1850 1851 1852 1853 |
jme_open(struct net_device *netdev) { struct jme_adapter *jme = netdev_priv(netdev); int rc; jme_clear_pm(jme); JME_NAPI_ENABLE(jme); |
71c6c837a drivers/net: fix ... |
1854 1855 1856 1857 1858 1859 1860 1861 |
tasklet_init(&jme->linkch_task, jme_link_change_tasklet, (unsigned long) jme); tasklet_init(&jme->txclean_task, jme_tx_clean_tasklet, (unsigned long) jme); tasklet_init(&jme->rxclean_task, jme_rx_clean_tasklet, (unsigned long) jme); tasklet_init(&jme->rxempty_task, jme_rx_empty_tasklet, (unsigned long) jme); |
95252236e jme: JMicron Giga... |
1862 1863 1864 1865 |
rc = jme_request_irq(jme); if (rc) goto err_out; |
95252236e jme: JMicron Giga... |
1866 |
jme_start_irq(jme); |
4872b11fd jme: PHY Power co... |
1867 1868 |
jme_phy_on(jme); if (test_bit(JME_FLAG_SSET, &jme->flags)) |
95252236e jme: JMicron Giga... |
1869 |
jme_set_settings(netdev, &jme->old_ecmd); |
4872b11fd jme: PHY Power co... |
1870 |
else |
95252236e jme: JMicron Giga... |
1871 |
jme_reset_phy_processor(jme); |
c4860ba2e jme: PHY configur... |
1872 1873 |
jme_phy_calibration(jme); jme_phy_setEA(jme); |
95252236e jme: JMicron Giga... |
1874 1875 1876 1877 1878 1879 1880 1881 1882 1883 1884 1885 1886 1887 |
jme_reset_link(jme); return 0; err_out: netif_stop_queue(netdev); netif_carrier_off(netdev); return rc; } static void jme_set_100m_half(struct jme_adapter *jme) { u32 bmcr, tmp; |
1c5578194 jme: Support WoL ... |
1888 |
jme_phy_on(jme); |
95252236e jme: JMicron Giga... |
1889 1890 1891 1892 1893 1894 1895 1896 1897 1898 1899 1900 1901 1902 1903 1904 1905 1906 1907 1908 1909 1910 1911 1912 1913 1914 1915 |
bmcr = jme_mdio_read(jme->dev, jme->mii_if.phy_id, MII_BMCR); tmp = bmcr & ~(BMCR_ANENABLE | BMCR_SPEED100 | BMCR_SPEED1000 | BMCR_FULLDPLX); tmp |= BMCR_SPEED100; if (bmcr != tmp) jme_mdio_write(jme->dev, jme->mii_if.phy_id, MII_BMCR, tmp); if (jme->fpgaver) jwrite32(jme, JME_GHC, GHC_SPEED_100M | GHC_LINK_POLL); else jwrite32(jme, JME_GHC, GHC_SPEED_100M); } #define JME_WAIT_LINK_TIME 2000 /* 2000ms */ static void jme_wait_link(struct jme_adapter *jme) { u32 phylink, to = JME_WAIT_LINK_TIME; mdelay(1000); phylink = jme_linkstat_from_phy(jme); while (!(phylink & PHY_LINK_UP) && (to -= 10) > 0) { mdelay(10); phylink = jme_linkstat_from_phy(jme); } } |
1c5578194 jme: Support WoL ... |
1916 1917 1918 1919 1920 |
static void jme_powersave_phy(struct jme_adapter *jme) { if (jme->reg_pmcs) { jme_set_100m_half(jme); |
1c5578194 jme: Support WoL ... |
1921 1922 |
if (jme->reg_pmcs & (PMCS_LFEN | PMCS_LREN)) jme_wait_link(jme); |
bc057e036 jme: Cleanup PM o... |
1923 |
jme_clear_pm(jme); |
1c5578194 jme: Support WoL ... |
1924 1925 1926 1927 |
} else { jme_phy_off(jme); } } |
95252236e jme: JMicron Giga... |
1928 1929 1930 1931 1932 1933 1934 1935 1936 |
static int jme_close(struct net_device *netdev) { struct jme_adapter *jme = netdev_priv(netdev); netif_stop_queue(netdev); netif_carrier_off(netdev); jme_stop_irq(jme); |
95252236e jme: JMicron Giga... |
1937 1938 1939 |
jme_free_irq(jme); JME_NAPI_DISABLE(jme); |
175c0dffe drivers/net: use ... |
1940 1941 1942 1943 |
tasklet_kill(&jme->linkch_task); tasklet_kill(&jme->txclean_task); tasklet_kill(&jme->rxclean_task); tasklet_kill(&jme->rxempty_task); |
95252236e jme: JMicron Giga... |
1944 |
|
95252236e jme: JMicron Giga... |
1945 1946 1947 1948 1949 1950 1951 1952 1953 1954 1955 1956 1957 1958 1959 |
jme_disable_rx_engine(jme); jme_disable_tx_engine(jme); jme_reset_mac_processor(jme); jme_free_rx_resources(jme); jme_free_tx_resources(jme); jme->phylink = 0; jme_phy_off(jme); return 0; } static int jme_alloc_txdesc(struct jme_adapter *jme, struct sk_buff *skb) { |
eacf69a15 jme: Some minor c... |
1960 |
struct jme_ring *txring = &(jme->txring[0]); |
95252236e jme: JMicron Giga... |
1961 1962 1963 1964 1965 1966 1967 1968 1969 1970 1971 1972 1973 1974 1975 1976 1977 1978 1979 1980 1981 1982 |
int idx, nr_alloc, mask = jme->tx_ring_mask; idx = txring->next_to_use; nr_alloc = skb_shinfo(skb)->nr_frags + 2; if (unlikely(atomic_read(&txring->nr_free) < nr_alloc)) return -1; atomic_sub(nr_alloc, &txring->nr_free); txring->next_to_use = (txring->next_to_use + nr_alloc) & mask; return idx; } static void jme_fill_tx_map(struct pci_dev *pdev, struct txdesc *txdesc, struct jme_buffer_info *txbi, struct page *page, u32 page_offset, u32 len, |
3ad9b358e net: drivers: use... |
1983 |
bool hidma) |
95252236e jme: JMicron Giga... |
1984 1985 1986 1987 1988 1989 1990 1991 1992 1993 1994 1995 1996 1997 1998 1999 2000 2001 2002 2003 2004 2005 2006 2007 2008 2009 2010 2011 2012 2013 |
{ dma_addr_t dmaaddr; dmaaddr = pci_map_page(pdev, page, page_offset, len, PCI_DMA_TODEVICE); pci_dma_sync_single_for_device(pdev, dmaaddr, len, PCI_DMA_TODEVICE); txdesc->dw[0] = 0; txdesc->dw[1] = 0; txdesc->desc2.flags = TXFLAG_OWN; txdesc->desc2.flags |= (hidma) ? TXFLAG_64BIT : 0; txdesc->desc2.datalen = cpu_to_le16(len); txdesc->desc2.bufaddrh = cpu_to_le32((__u64)dmaaddr >> 32); txdesc->desc2.bufaddrl = cpu_to_le32( (__u64)dmaaddr & 0xFFFFFFFFUL); txbi->mapping = dmaaddr; txbi->len = len; } static void jme_map_tx_skb(struct jme_adapter *jme, struct sk_buff *skb, int idx) { |
eacf69a15 jme: Some minor c... |
2014 |
struct jme_ring *txring = &(jme->txring[0]); |
95252236e jme: JMicron Giga... |
2015 2016 |
struct txdesc *txdesc = txring->desc, *ctxdesc; struct jme_buffer_info *txbi = txring->bufinf, *ctxbi; |
3ad9b358e net: drivers: use... |
2017 |
bool hidma = jme->dev->features & NETIF_F_HIGHDMA; |
95252236e jme: JMicron Giga... |
2018 2019 |
int i, nr_frags = skb_shinfo(skb)->nr_frags; int mask = jme->tx_ring_mask; |
9e903e085 net: add skb frag... |
2020 |
const struct skb_frag_struct *frag; |
95252236e jme: JMicron Giga... |
2021 2022 2023 2024 2025 2026 |
u32 len; for (i = 0 ; i < nr_frags ; ++i) { frag = &skb_shinfo(skb)->frags[i]; ctxdesc = txdesc + ((idx + i + 2) & (mask)); ctxbi = txbi + ((idx + i + 2) & (mask)); |
f327358ab jme: convert to S... |
2027 2028 |
jme_fill_tx_map(jme->pdev, ctxdesc, ctxbi, skb_frag_page(frag), |
9e903e085 net: add skb frag... |
2029 |
frag->page_offset, skb_frag_size(frag), hidma); |
95252236e jme: JMicron Giga... |
2030 2031 2032 2033 2034 2035 2036 2037 2038 2039 2040 |
} len = skb_is_nonlinear(skb) ? skb_headlen(skb) : skb->len; ctxdesc = txdesc + ((idx + 1) & (mask)); ctxbi = txbi + ((idx + 1) & (mask)); jme_fill_tx_map(jme->pdev, ctxdesc, ctxbi, virt_to_page(skb->data), offset_in_page(skb->data), len, hidma); } static int |
31c221c49 net: jme.c rxdesc... |
2041 |
jme_tx_tso(struct sk_buff *skb, __le16 *mss, u8 *flags) |
95252236e jme: JMicron Giga... |
2042 |
{ |
31c221c49 net: jme.c rxdesc... |
2043 |
*mss = cpu_to_le16(skb_shinfo(skb)->gso_size << TXDESC_MSS_SHIFT); |
95252236e jme: JMicron Giga... |
2044 2045 2046 2047 2048 2049 2050 2051 2052 2053 2054 2055 2056 2057 2058 2059 2060 2061 2062 2063 2064 2065 2066 2067 2068 2069 2070 2071 2072 2073 2074 2075 2076 2077 2078 2079 2080 2081 2082 2083 2084 2085 2086 2087 2088 2089 2090 2091 2092 2093 2094 2095 |
if (*mss) { *flags |= TXFLAG_LSEN; if (skb->protocol == htons(ETH_P_IP)) { struct iphdr *iph = ip_hdr(skb); iph->check = 0; tcp_hdr(skb)->check = ~csum_tcpudp_magic(iph->saddr, iph->daddr, 0, IPPROTO_TCP, 0); } else { struct ipv6hdr *ip6h = ipv6_hdr(skb); tcp_hdr(skb)->check = ~csum_ipv6_magic(&ip6h->saddr, &ip6h->daddr, 0, IPPROTO_TCP, 0); } return 0; } return 1; } static void jme_tx_csum(struct jme_adapter *jme, struct sk_buff *skb, u8 *flags) { if (skb->ip_summed == CHECKSUM_PARTIAL) { u8 ip_proto; switch (skb->protocol) { case htons(ETH_P_IP): ip_proto = ip_hdr(skb)->protocol; break; case htons(ETH_P_IPV6): ip_proto = ipv6_hdr(skb)->nexthdr; break; default: ip_proto = 0; break; } switch (ip_proto) { case IPPROTO_TCP: *flags |= TXFLAG_TCPCS; break; case IPPROTO_UDP: *flags |= TXFLAG_UDPCS; break; default: |
49d70c485 drivers/net/jme: ... |
2096 2097 |
netif_err(jme, tx_err, jme->dev, "Error upper layer protocol "); |
95252236e jme: JMicron Giga... |
2098 2099 2100 2101 2102 2103 |
break; } } } static inline void |
31c221c49 net: jme.c rxdesc... |
2104 |
jme_tx_vlan(struct sk_buff *skb, __le16 *vlan, u8 *flags) |
95252236e jme: JMicron Giga... |
2105 2106 2107 |
{ if (vlan_tx_tag_present(skb)) { *flags |= TXFLAG_TAGON; |
31c221c49 net: jme.c rxdesc... |
2108 |
*vlan = cpu_to_le16(vlan_tx_tag_get(skb)); |
95252236e jme: JMicron Giga... |
2109 2110 2111 2112 |
} } static int |
7f7fd2da9 jme: Fix pci sync |
2113 |
jme_fill_tx_desc(struct jme_adapter *jme, struct sk_buff *skb, int idx) |
95252236e jme: JMicron Giga... |
2114 |
{ |
eacf69a15 jme: Some minor c... |
2115 |
struct jme_ring *txring = &(jme->txring[0]); |
95252236e jme: JMicron Giga... |
2116 2117 2118 2119 2120 2121 2122 2123 2124 2125 2126 2127 2128 2129 2130 2131 2132 2133 2134 2135 2136 2137 2138 2139 2140 2141 2142 |
struct txdesc *txdesc; struct jme_buffer_info *txbi; u8 flags; txdesc = (struct txdesc *)txring->desc + idx; txbi = txring->bufinf + idx; txdesc->dw[0] = 0; txdesc->dw[1] = 0; txdesc->dw[2] = 0; txdesc->dw[3] = 0; txdesc->desc1.pktsize = cpu_to_le16(skb->len); /* * Set OWN bit at final. * When kernel transmit faster than NIC. * And NIC trying to send this descriptor before we tell * it to start sending this TX queue. * Other fields are already filled correctly. */ wmb(); flags = TXFLAG_OWN | TXFLAG_INT; /* * Set checksum flags while not tso */ if (jme_tx_tso(skb, &txdesc->desc1.mss, &flags)) jme_tx_csum(jme, skb, &flags); jme_tx_vlan(skb, &txdesc->desc1.vlan, &flags); |
7f7fd2da9 jme: Fix pci sync |
2143 |
jme_map_tx_skb(jme, skb, idx); |
95252236e jme: JMicron Giga... |
2144 2145 2146 2147 2148 2149 2150 2151 2152 2153 2154 2155 2156 2157 2158 2159 2160 2161 2162 |
txdesc->desc1.flags = flags; /* * Set tx buffer info after telling NIC to send * For better tx_clean timing */ wmb(); txbi->nr_desc = skb_shinfo(skb)->nr_frags + 2; txbi->skb = skb; txbi->len = skb->len; txbi->start_xmit = jiffies; if (!txbi->start_xmit) txbi->start_xmit = (0UL-1); return 0; } static void jme_stop_queue_if_full(struct jme_adapter *jme) { |
eacf69a15 jme: Some minor c... |
2163 |
struct jme_ring *txring = &(jme->txring[0]); |
95252236e jme: JMicron Giga... |
2164 2165 2166 2167 2168 2169 2170 2171 |
struct jme_buffer_info *txbi = txring->bufinf; int idx = atomic_read(&txring->next_to_clean); txbi += idx; smp_wmb(); if (unlikely(atomic_read(&txring->nr_free) < (MAX_SKB_FRAGS+2))) { netif_stop_queue(jme->dev); |
49d70c485 drivers/net/jme: ... |
2172 2173 |
netif_info(jme, tx_queued, jme->dev, "TX Queue Paused "); |
95252236e jme: JMicron Giga... |
2174 2175 2176 2177 |
smp_wmb(); if (atomic_read(&txring->nr_free) >= (jme->tx_wake_threshold)) { netif_wake_queue(jme->dev); |
49d70c485 drivers/net/jme: ... |
2178 2179 |
netif_info(jme, tx_queued, jme->dev, "TX Queue Fast Waked "); |
95252236e jme: JMicron Giga... |
2180 2181 2182 2183 2184 2185 2186 |
} } if (unlikely(txbi->start_xmit && (jiffies - txbi->start_xmit) >= TX_TIMEOUT && txbi->skb)) { netif_stop_queue(jme->dev); |
49d70c485 drivers/net/jme: ... |
2187 2188 2189 |
netif_info(jme, tx_queued, jme->dev, "TX Queue Stopped %d@%lu ", idx, jiffies); |
95252236e jme: JMicron Giga... |
2190 2191 2192 2193 2194 2195 |
} } /* * This function is already protected by netif_tx_lock() */ |
61357325f netdev: convert b... |
2196 |
static netdev_tx_t |
95252236e jme: JMicron Giga... |
2197 2198 2199 2200 |
jme_start_xmit(struct sk_buff *skb, struct net_device *netdev) { struct jme_adapter *jme = netdev_priv(netdev); int idx; |
ba4e6d192 jme: remove open-... |
2201 2202 |
if (unlikely(skb_is_gso(skb) && skb_cow_head(skb, 0))) { dev_kfree_skb_any(skb); |
95252236e jme: JMicron Giga... |
2203 2204 2205 2206 2207 2208 2209 2210 |
++(NET_STAT(jme).tx_dropped); return NETDEV_TX_OK; } idx = jme_alloc_txdesc(jme, skb); if (unlikely(idx < 0)) { netif_stop_queue(netdev); |
49d70c485 drivers/net/jme: ... |
2211 2212 2213 |
netif_err(jme, tx_err, jme->dev, "BUG! Tx ring full when queue awake! "); |
95252236e jme: JMicron Giga... |
2214 2215 2216 |
return NETDEV_TX_BUSY; } |
7f7fd2da9 jme: Fix pci sync |
2217 |
jme_fill_tx_desc(jme, skb, idx); |
95252236e jme: JMicron Giga... |
2218 2219 2220 2221 2222 |
jwrite32(jme, JME_TXCS, jme->reg_txcs | TXCS_SELECT_QUEUE0 | TXCS_QUEUE0S | TXCS_ENABLE); |
95252236e jme: JMicron Giga... |
2223 |
|
49d70c485 drivers/net/jme: ... |
2224 2225 2226 |
tx_dbg(jme, "xmit: %d+%d@%lu ", idx, skb_shinfo(skb)->nr_frags + 2, jiffies); |
95252236e jme: JMicron Giga... |
2227 2228 2229 2230 |
jme_stop_queue_if_full(jme); return NETDEV_TX_OK; } |
8b53abae5 jme: Refill recei... |
2231 2232 2233 2234 2235 2236 2237 2238 2239 2240 2241 2242 2243 2244 2245 |
static void jme_set_unicastaddr(struct net_device *netdev) { struct jme_adapter *jme = netdev_priv(netdev); u32 val; val = (netdev->dev_addr[3] & 0xff) << 24 | (netdev->dev_addr[2] & 0xff) << 16 | (netdev->dev_addr[1] & 0xff) << 8 | (netdev->dev_addr[0] & 0xff); jwrite32(jme, JME_RXUMA_LO, val); val = (netdev->dev_addr[5] & 0xff) << 8 | (netdev->dev_addr[4] & 0xff); jwrite32(jme, JME_RXUMA_HI, val); } |
95252236e jme: JMicron Giga... |
2246 2247 2248 2249 2250 |
static int jme_set_macaddr(struct net_device *netdev, void *p) { struct jme_adapter *jme = netdev_priv(netdev); struct sockaddr *addr = p; |
95252236e jme: JMicron Giga... |
2251 2252 2253 2254 2255 2256 |
if (netif_running(netdev)) return -EBUSY; spin_lock_bh(&jme->macaddr_lock); memcpy(netdev->dev_addr, addr->sa_data, netdev->addr_len); |
8b53abae5 jme: Refill recei... |
2257 |
jme_set_unicastaddr(netdev); |
95252236e jme: JMicron Giga... |
2258 2259 2260 2261 2262 2263 2264 2265 2266 2267 |
spin_unlock_bh(&jme->macaddr_lock); return 0; } static void jme_set_multi(struct net_device *netdev) { struct jme_adapter *jme = netdev_priv(netdev); u32 mc_hash[2] = {}; |
95252236e jme: JMicron Giga... |
2268 2269 2270 2271 2272 2273 2274 2275 2276 2277 |
spin_lock_bh(&jme->rxmcs_lock); jme->reg_rxmcs |= RXMCS_BRDFRAME | RXMCS_UNIFRAME; if (netdev->flags & IFF_PROMISC) { jme->reg_rxmcs |= RXMCS_ALLFRAME; } else if (netdev->flags & IFF_ALLMULTI) { jme->reg_rxmcs |= RXMCS_ALLMULFRAME; } else if (netdev->flags & IFF_MULTICAST) { |
22bedad3c net: convert mult... |
2278 |
struct netdev_hw_addr *ha; |
95252236e jme: JMicron Giga... |
2279 2280 2281 |
int bit_nr; jme->reg_rxmcs |= RXMCS_MULFRAME | RXMCS_MULFILTERED; |
22bedad3c net: convert mult... |
2282 2283 |
netdev_for_each_mc_addr(ha, netdev) { bit_nr = ether_crc(ETH_ALEN, ha->addr) & 0x3F; |
95252236e jme: JMicron Giga... |
2284 2285 2286 2287 2288 2289 2290 2291 2292 2293 2294 2295 2296 2297 2298 2299 2300 2301 2302 2303 2304 2305 2306 2307 |
mc_hash[bit_nr >> 5] |= 1 << (bit_nr & 0x1F); } jwrite32(jme, JME_RXMCHT_LO, mc_hash[0]); jwrite32(jme, JME_RXMCHT_HI, mc_hash[1]); } wmb(); jwrite32(jme, JME_RXMCS, jme->reg_rxmcs); spin_unlock_bh(&jme->rxmcs_lock); } static int jme_change_mtu(struct net_device *netdev, int new_mtu) { struct jme_adapter *jme = netdev_priv(netdev); if (new_mtu == jme->old_mtu) return 0; if (((new_mtu + ETH_HLEN) > MAX_ETHERNET_JUMBO_PACKET_SIZE) || ((new_mtu) < IPV6_MIN_MTU)) return -EINVAL; |
95252236e jme: JMicron Giga... |
2308 |
|
95252236e jme: JMicron Giga... |
2309 |
netdev->mtu = new_mtu; |
d7b576545 jme: convert offl... |
2310 |
netdev_update_features(netdev); |
ba9adbe67 jme: Fix FIFO flu... |
2311 |
jme_restart_rx_engine(jme); |
95252236e jme: JMicron Giga... |
2312 2313 2314 2315 2316 2317 2318 2319 2320 2321 2322 2323 2324 2325 2326 2327 2328 2329 2330 2331 |
jme_reset_link(jme); return 0; } static void jme_tx_timeout(struct net_device *netdev) { struct jme_adapter *jme = netdev_priv(netdev); jme->phylink = 0; jme_reset_phy_processor(jme); if (test_bit(JME_FLAG_SSET, &jme->flags)) jme_set_settings(netdev, &jme->old_ecmd); /* * Force to Reset the link again */ jme_reset_link(jme); } |
bf5e5360f jme: Protect vlgr... |
2332 2333 2334 2335 2336 2337 2338 2339 2340 2341 2342 2343 2344 2345 2346 2347 2348 2349 2350 2351 2352 2353 2354 2355 2356 2357 2358 2359 2360 2361 |
static inline void jme_pause_rx(struct jme_adapter *jme) { atomic_dec(&jme->link_changing); jme_set_rx_pcc(jme, PCC_OFF); if (test_bit(JME_FLAG_POLL, &jme->flags)) { JME_NAPI_DISABLE(jme); } else { tasklet_disable(&jme->rxclean_task); tasklet_disable(&jme->rxempty_task); } } static inline void jme_resume_rx(struct jme_adapter *jme) { struct dynpcc_info *dpi = &(jme->dpi); if (test_bit(JME_FLAG_POLL, &jme->flags)) { JME_NAPI_ENABLE(jme); } else { tasklet_hi_enable(&jme->rxclean_task); tasklet_hi_enable(&jme->rxempty_task); } dpi->cur = PCC_P1; dpi->attempt = PCC_P1; dpi->cnt = 0; jme_set_rx_pcc(jme, PCC_P1); atomic_inc(&jme->link_changing); } |
95252236e jme: JMicron Giga... |
2362 |
static void |
95252236e jme: JMicron Giga... |
2363 2364 2365 2366 |
jme_get_drvinfo(struct net_device *netdev, struct ethtool_drvinfo *info) { struct jme_adapter *jme = netdev_priv(netdev); |
23020ab35 Sweep additional ... |
2367 2368 2369 |
strlcpy(info->driver, DRV_NAME, sizeof(info->driver)); strlcpy(info->version, DRV_VERSION, sizeof(info->version)); strlcpy(info->bus_info, pci_name(jme->pdev), sizeof(info->bus_info)); |
95252236e jme: JMicron Giga... |
2370 2371 2372 2373 2374 2375 2376 2377 2378 2379 2380 2381 2382 2383 2384 2385 2386 2387 2388 2389 2390 2391 2392 2393 2394 2395 2396 2397 2398 2399 2400 2401 2402 2403 2404 2405 2406 2407 2408 2409 2410 2411 2412 2413 2414 2415 2416 2417 2418 2419 2420 2421 2422 2423 2424 2425 2426 2427 2428 2429 2430 2431 2432 2433 2434 2435 2436 2437 2438 2439 2440 2441 2442 2443 2444 2445 2446 2447 2448 2449 2450 2451 2452 2453 2454 2455 2456 2457 2458 2459 2460 2461 2462 2463 2464 2465 |
} static int jme_get_regs_len(struct net_device *netdev) { return JME_REG_LEN; } static void mmapio_memcpy(struct jme_adapter *jme, u32 *p, u32 reg, int len) { int i; for (i = 0 ; i < len ; i += 4) p[i >> 2] = jread32(jme, reg + i); } static void mdio_memcpy(struct jme_adapter *jme, u32 *p, int reg_nr) { int i; u16 *p16 = (u16 *)p; for (i = 0 ; i < reg_nr ; ++i) p16[i] = jme_mdio_read(jme->dev, jme->mii_if.phy_id, i); } static void jme_get_regs(struct net_device *netdev, struct ethtool_regs *regs, void *p) { struct jme_adapter *jme = netdev_priv(netdev); u32 *p32 = (u32 *)p; memset(p, 0xFF, JME_REG_LEN); regs->version = 1; mmapio_memcpy(jme, p32, JME_MAC, JME_MAC_LEN); p32 += 0x100 >> 2; mmapio_memcpy(jme, p32, JME_PHY, JME_PHY_LEN); p32 += 0x100 >> 2; mmapio_memcpy(jme, p32, JME_MISC, JME_MISC_LEN); p32 += 0x100 >> 2; mmapio_memcpy(jme, p32, JME_RSS, JME_RSS_LEN); p32 += 0x100 >> 2; mdio_memcpy(jme, p32, JME_PHY_REG_NR); } static int jme_get_coalesce(struct net_device *netdev, struct ethtool_coalesce *ecmd) { struct jme_adapter *jme = netdev_priv(netdev); ecmd->tx_coalesce_usecs = PCC_TX_TO; ecmd->tx_max_coalesced_frames = PCC_TX_CNT; if (test_bit(JME_FLAG_POLL, &jme->flags)) { ecmd->use_adaptive_rx_coalesce = false; ecmd->rx_coalesce_usecs = 0; ecmd->rx_max_coalesced_frames = 0; return 0; } ecmd->use_adaptive_rx_coalesce = true; switch (jme->dpi.cur) { case PCC_P1: ecmd->rx_coalesce_usecs = PCC_P1_TO; ecmd->rx_max_coalesced_frames = PCC_P1_CNT; break; case PCC_P2: ecmd->rx_coalesce_usecs = PCC_P2_TO; ecmd->rx_max_coalesced_frames = PCC_P2_CNT; break; case PCC_P3: ecmd->rx_coalesce_usecs = PCC_P3_TO; ecmd->rx_max_coalesced_frames = PCC_P3_CNT; break; default: break; } return 0; } static int jme_set_coalesce(struct net_device *netdev, struct ethtool_coalesce *ecmd) { struct jme_adapter *jme = netdev_priv(netdev); struct dynpcc_info *dpi = &(jme->dpi); if (netif_running(netdev)) return -EBUSY; |
8e95a2026 drivers/net: Move... |
2466 2467 |
if (ecmd->use_adaptive_rx_coalesce && test_bit(JME_FLAG_POLL, &jme->flags)) { |
95252236e jme: JMicron Giga... |
2468 2469 |
clear_bit(JME_FLAG_POLL, &jme->flags); jme->jme_rx = netif_rx; |
95252236e jme: JMicron Giga... |
2470 2471 2472 2473 2474 |
dpi->cur = PCC_P1; dpi->attempt = PCC_P1; dpi->cnt = 0; jme_set_rx_pcc(jme, PCC_P1); jme_interrupt_mode(jme); |
8e95a2026 drivers/net: Move... |
2475 2476 |
} else if (!(ecmd->use_adaptive_rx_coalesce) && !(test_bit(JME_FLAG_POLL, &jme->flags))) { |
95252236e jme: JMicron Giga... |
2477 2478 |
set_bit(JME_FLAG_POLL, &jme->flags); jme->jme_rx = netif_receive_skb; |
95252236e jme: JMicron Giga... |
2479 2480 2481 2482 2483 2484 2485 2486 2487 2488 2489 2490 2491 2492 2493 2494 2495 2496 2497 2498 2499 2500 2501 2502 2503 2504 2505 2506 2507 2508 2509 2510 2511 2512 2513 2514 2515 2516 2517 2518 2519 2520 2521 2522 2523 2524 2525 2526 2527 2528 2529 2530 2531 2532 2533 2534 2535 2536 2537 2538 2539 2540 2541 2542 2543 2544 2545 2546 2547 2548 2549 2550 2551 2552 2553 2554 2555 2556 2557 2558 2559 2560 2561 2562 2563 2564 2565 2566 2567 2568 2569 2570 2571 2572 2573 2574 2575 2576 2577 2578 2579 2580 2581 2582 2583 2584 2585 2586 2587 2588 2589 2590 2591 |
jme_interrupt_mode(jme); } return 0; } static void jme_get_pauseparam(struct net_device *netdev, struct ethtool_pauseparam *ecmd) { struct jme_adapter *jme = netdev_priv(netdev); u32 val; ecmd->tx_pause = (jme->reg_txpfc & TXPFC_PF_EN) != 0; ecmd->rx_pause = (jme->reg_rxmcs & RXMCS_FLOWCTRL) != 0; spin_lock_bh(&jme->phy_lock); val = jme_mdio_read(jme->dev, jme->mii_if.phy_id, MII_ADVERTISE); spin_unlock_bh(&jme->phy_lock); ecmd->autoneg = (val & (ADVERTISE_PAUSE_CAP | ADVERTISE_PAUSE_ASYM)) != 0; } static int jme_set_pauseparam(struct net_device *netdev, struct ethtool_pauseparam *ecmd) { struct jme_adapter *jme = netdev_priv(netdev); u32 val; if (((jme->reg_txpfc & TXPFC_PF_EN) != 0) ^ (ecmd->tx_pause != 0)) { if (ecmd->tx_pause) jme->reg_txpfc |= TXPFC_PF_EN; else jme->reg_txpfc &= ~TXPFC_PF_EN; jwrite32(jme, JME_TXPFC, jme->reg_txpfc); } spin_lock_bh(&jme->rxmcs_lock); if (((jme->reg_rxmcs & RXMCS_FLOWCTRL) != 0) ^ (ecmd->rx_pause != 0)) { if (ecmd->rx_pause) jme->reg_rxmcs |= RXMCS_FLOWCTRL; else jme->reg_rxmcs &= ~RXMCS_FLOWCTRL; jwrite32(jme, JME_RXMCS, jme->reg_rxmcs); } spin_unlock_bh(&jme->rxmcs_lock); spin_lock_bh(&jme->phy_lock); val = jme_mdio_read(jme->dev, jme->mii_if.phy_id, MII_ADVERTISE); if (((val & (ADVERTISE_PAUSE_CAP | ADVERTISE_PAUSE_ASYM)) != 0) ^ (ecmd->autoneg != 0)) { if (ecmd->autoneg) val |= (ADVERTISE_PAUSE_CAP | ADVERTISE_PAUSE_ASYM); else val &= ~(ADVERTISE_PAUSE_CAP | ADVERTISE_PAUSE_ASYM); jme_mdio_write(jme->dev, jme->mii_if.phy_id, MII_ADVERTISE, val); } spin_unlock_bh(&jme->phy_lock); return 0; } static void jme_get_wol(struct net_device *netdev, struct ethtool_wolinfo *wol) { struct jme_adapter *jme = netdev_priv(netdev); wol->supported = WAKE_MAGIC | WAKE_PHY; wol->wolopts = 0; if (jme->reg_pmcs & (PMCS_LFEN | PMCS_LREN)) wol->wolopts |= WAKE_PHY; if (jme->reg_pmcs & PMCS_MFEN) wol->wolopts |= WAKE_MAGIC; } static int jme_set_wol(struct net_device *netdev, struct ethtool_wolinfo *wol) { struct jme_adapter *jme = netdev_priv(netdev); if (wol->wolopts & (WAKE_MAGICSECURE | WAKE_UCAST | WAKE_MCAST | WAKE_BCAST | WAKE_ARP)) return -EOPNOTSUPP; jme->reg_pmcs = 0; if (wol->wolopts & WAKE_PHY) jme->reg_pmcs |= PMCS_LFEN | PMCS_LREN; if (wol->wolopts & WAKE_MAGIC) jme->reg_pmcs |= PMCS_MFEN; jwrite32(jme, JME_PMCS, jme->reg_pmcs); |
bc057e036 jme: Cleanup PM o... |
2592 |
device_set_wakeup_enable(&jme->pdev->dev, !!(jme->reg_pmcs)); |
f4e5bd4f5 Net / jme: Do not... |
2593 |
|
95252236e jme: JMicron Giga... |
2594 2595 2596 2597 2598 2599 2600 2601 2602 2603 2604 2605 2606 2607 2608 2609 2610 2611 2612 2613 2614 2615 |
return 0; } static int jme_get_settings(struct net_device *netdev, struct ethtool_cmd *ecmd) { struct jme_adapter *jme = netdev_priv(netdev); int rc; spin_lock_bh(&jme->phy_lock); rc = mii_ethtool_gset(&(jme->mii_if), ecmd); spin_unlock_bh(&jme->phy_lock); return rc; } static int jme_set_settings(struct net_device *netdev, struct ethtool_cmd *ecmd) { struct jme_adapter *jme = netdev_priv(netdev); int rc, fdc = 0; |
25db03388 ethtool: Use full... |
2616 2617 |
if (ethtool_cmd_speed(ecmd) == SPEED_1000 && ecmd->autoneg != AUTONEG_ENABLE) |
95252236e jme: JMicron Giga... |
2618 |
return -EINVAL; |
3ee94018a jme: Add comment ... |
2619 2620 2621 2622 |
/* * Check If user changed duplex only while force_media. * Hardware would not generate link change interrupt. */ |
95252236e jme: JMicron Giga... |
2623 2624 2625 2626 2627 2628 2629 2630 |
if (jme->mii_if.force_media && ecmd->autoneg != AUTONEG_ENABLE && (jme->mii_if.full_duplex != ecmd->duplex)) fdc = 1; spin_lock_bh(&jme->phy_lock); rc = mii_ethtool_sset(&(jme->mii_if), ecmd); spin_unlock_bh(&jme->phy_lock); |
95252236e jme: JMicron Giga... |
2631 |
if (!rc) { |
3ee94018a jme: Add comment ... |
2632 2633 |
if (fdc) jme_reset_link(jme); |
95252236e jme: JMicron Giga... |
2634 |
jme->old_ecmd = *ecmd; |
334fbbb74 jme: Adding mii-t... |
2635 2636 2637 2638 2639 2640 2641 2642 2643 2644 2645 2646 2647 2648 2649 2650 2651 2652 2653 2654 2655 2656 2657 2658 2659 2660 2661 2662 2663 2664 |
set_bit(JME_FLAG_SSET, &jme->flags); } return rc; } static int jme_ioctl(struct net_device *netdev, struct ifreq *rq, int cmd) { int rc; struct jme_adapter *jme = netdev_priv(netdev); struct mii_ioctl_data *mii_data = if_mii(rq); unsigned int duplex_chg; if (cmd == SIOCSMIIREG) { u16 val = mii_data->val_in; if (!(val & (BMCR_RESET|BMCR_ANENABLE)) && (val & BMCR_SPEED1000)) return -EINVAL; } spin_lock_bh(&jme->phy_lock); rc = generic_mii_ioctl(&jme->mii_if, mii_data, cmd, &duplex_chg); spin_unlock_bh(&jme->phy_lock); if (!rc && (cmd == SIOCSMIIREG)) { if (duplex_chg) jme_reset_link(jme); jme_get_settings(netdev, &jme->old_ecmd); set_bit(JME_FLAG_SSET, &jme->flags); |
95252236e jme: JMicron Giga... |
2665 2666 2667 2668 2669 2670 2671 2672 2673 2674 2675 2676 2677 2678 2679 2680 2681 2682 2683 2684 2685 2686 2687 2688 2689 |
} return rc; } static u32 jme_get_link(struct net_device *netdev) { struct jme_adapter *jme = netdev_priv(netdev); return jread32(jme, JME_PHY_LINK) & PHY_LINK_UP; } static u32 jme_get_msglevel(struct net_device *netdev) { struct jme_adapter *jme = netdev_priv(netdev); return jme->msg_enable; } static void jme_set_msglevel(struct net_device *netdev, u32 value) { struct jme_adapter *jme = netdev_priv(netdev); jme->msg_enable = value; } |
c8f44affb net: introduce an... |
2690 2691 |
static netdev_features_t jme_fix_features(struct net_device *netdev, netdev_features_t features) |
95252236e jme: JMicron Giga... |
2692 |
{ |
d7b576545 jme: convert offl... |
2693 2694 2695 |
if (netdev->mtu > 1900) features &= ~(NETIF_F_ALL_TSO | NETIF_F_ALL_CSUM); return features; |
95252236e jme: JMicron Giga... |
2696 2697 2698 |
} static int |
c8f44affb net: introduce an... |
2699 |
jme_set_features(struct net_device *netdev, netdev_features_t features) |
95252236e jme: JMicron Giga... |
2700 2701 2702 2703 |
{ struct jme_adapter *jme = netdev_priv(netdev); spin_lock_bh(&jme->rxmcs_lock); |
d7b576545 jme: convert offl... |
2704 |
if (features & NETIF_F_RXCSUM) |
95252236e jme: JMicron Giga... |
2705 2706 2707 2708 2709 2710 2711 2712 |
jme->reg_rxmcs |= RXMCS_CHECKSUM; else jme->reg_rxmcs &= ~RXMCS_CHECKSUM; jwrite32(jme, JME_RXMCS, jme->reg_rxmcs); spin_unlock_bh(&jme->rxmcs_lock); return 0; } |
ed36d7b25 jme: netpoll support |
2713 2714 2715 2716 2717 2718 2719 2720 2721 2722 |
#ifdef CONFIG_NET_POLL_CONTROLLER static void jme_netpoll(struct net_device *dev) { unsigned long flags; local_irq_save(flags); jme_intr(dev->irq, dev); local_irq_restore(flags); } #endif |
95252236e jme: JMicron Giga... |
2723 |
static int |
95252236e jme: JMicron Giga... |
2724 2725 2726 2727 2728 2729 2730 2731 2732 2733 2734 2735 2736 2737 2738 2739 2740 2741 2742 2743 |
jme_nway_reset(struct net_device *netdev) { struct jme_adapter *jme = netdev_priv(netdev); jme_restart_an(jme); return 0; } static u8 jme_smb_read(struct jme_adapter *jme, unsigned int addr) { u32 val; int to; val = jread32(jme, JME_SMBCSR); to = JME_SMB_BUSY_TIMEOUT; while ((val & SMBCSR_BUSY) && --to) { msleep(1); val = jread32(jme, JME_SMBCSR); } if (!to) { |
49d70c485 drivers/net/jme: ... |
2744 2745 |
netif_err(jme, hw, jme->dev, "SMB Bus Busy "); |
95252236e jme: JMicron Giga... |
2746 2747 2748 2749 2750 2751 2752 2753 2754 2755 2756 2757 2758 2759 2760 |
return 0xFF; } jwrite32(jme, JME_SMBINTF, ((addr << SMBINTF_HWADDR_SHIFT) & SMBINTF_HWADDR) | SMBINTF_HWRWN_READ | SMBINTF_HWCMD); val = jread32(jme, JME_SMBINTF); to = JME_SMB_BUSY_TIMEOUT; while ((val & SMBINTF_HWCMD) && --to) { msleep(1); val = jread32(jme, JME_SMBINTF); } if (!to) { |
49d70c485 drivers/net/jme: ... |
2761 2762 |
netif_err(jme, hw, jme->dev, "SMB Bus Busy "); |
95252236e jme: JMicron Giga... |
2763 2764 2765 2766 2767 2768 2769 2770 2771 2772 2773 2774 2775 2776 2777 2778 2779 2780 2781 |
return 0xFF; } return (val & SMBINTF_HWDATR) >> SMBINTF_HWDATR_SHIFT; } static void jme_smb_write(struct jme_adapter *jme, unsigned int addr, u8 data) { u32 val; int to; val = jread32(jme, JME_SMBCSR); to = JME_SMB_BUSY_TIMEOUT; while ((val & SMBCSR_BUSY) && --to) { msleep(1); val = jread32(jme, JME_SMBCSR); } if (!to) { |
49d70c485 drivers/net/jme: ... |
2782 2783 |
netif_err(jme, hw, jme->dev, "SMB Bus Busy "); |
95252236e jme: JMicron Giga... |
2784 2785 2786 2787 2788 2789 2790 2791 2792 2793 2794 2795 2796 2797 2798 2799 |
return; } jwrite32(jme, JME_SMBINTF, ((data << SMBINTF_HWDATW_SHIFT) & SMBINTF_HWDATW) | ((addr << SMBINTF_HWADDR_SHIFT) & SMBINTF_HWADDR) | SMBINTF_HWRWN_WRITE | SMBINTF_HWCMD); val = jread32(jme, JME_SMBINTF); to = JME_SMB_BUSY_TIMEOUT; while ((val & SMBINTF_HWCMD) && --to) { msleep(1); val = jread32(jme, JME_SMBINTF); } if (!to) { |
49d70c485 drivers/net/jme: ... |
2800 2801 |
netif_err(jme, hw, jme->dev, "SMB Bus Busy "); |
95252236e jme: JMicron Giga... |
2802 2803 2804 2805 2806 2807 2808 2809 2810 2811 2812 2813 2814 2815 2816 2817 2818 2819 2820 2821 2822 2823 2824 2825 2826 2827 2828 2829 2830 2831 2832 2833 2834 2835 2836 2837 2838 2839 2840 2841 2842 2843 2844 2845 2846 2847 2848 2849 2850 2851 2852 2853 2854 2855 2856 2857 2858 2859 2860 2861 2862 2863 2864 2865 2866 2867 |
return; } mdelay(2); } static int jme_get_eeprom_len(struct net_device *netdev) { struct jme_adapter *jme = netdev_priv(netdev); u32 val; val = jread32(jme, JME_SMBCSR); return (val & SMBCSR_EEPROMD) ? JME_SMB_LEN : 0; } static int jme_get_eeprom(struct net_device *netdev, struct ethtool_eeprom *eeprom, u8 *data) { struct jme_adapter *jme = netdev_priv(netdev); int i, offset = eeprom->offset, len = eeprom->len; /* * ethtool will check the boundary for us */ eeprom->magic = JME_EEPROM_MAGIC; for (i = 0 ; i < len ; ++i) data[i] = jme_smb_read(jme, i + offset); return 0; } static int jme_set_eeprom(struct net_device *netdev, struct ethtool_eeprom *eeprom, u8 *data) { struct jme_adapter *jme = netdev_priv(netdev); int i, offset = eeprom->offset, len = eeprom->len; if (eeprom->magic != JME_EEPROM_MAGIC) return -EINVAL; /* * ethtool will check the boundary for us */ for (i = 0 ; i < len ; ++i) jme_smb_write(jme, i + offset, data[i]); return 0; } static const struct ethtool_ops jme_ethtool_ops = { .get_drvinfo = jme_get_drvinfo, .get_regs_len = jme_get_regs_len, .get_regs = jme_get_regs, .get_coalesce = jme_get_coalesce, .set_coalesce = jme_set_coalesce, .get_pauseparam = jme_get_pauseparam, .set_pauseparam = jme_set_pauseparam, .get_wol = jme_get_wol, .set_wol = jme_set_wol, .get_settings = jme_get_settings, .set_settings = jme_set_settings, .get_link = jme_get_link, .get_msglevel = jme_get_msglevel, .set_msglevel = jme_set_msglevel, |
95252236e jme: JMicron Giga... |
2868 2869 2870 2871 2872 2873 2874 2875 2876 |
.nway_reset = jme_nway_reset, .get_eeprom_len = jme_get_eeprom_len, .get_eeprom = jme_get_eeprom, .set_eeprom = jme_set_eeprom, }; static int jme_pci_dma64(struct pci_dev *pdev) { |
814c01dc7 jme: Adding {64,4... |
2877 |
if (pdev->device == PCI_DEVICE_ID_JMICRON_JMC250 && |
e930438c4 Replace all DMA_n... |
2878 2879 |
!pci_set_dma_mask(pdev, DMA_BIT_MASK(64))) if (!pci_set_consistent_dma_mask(pdev, DMA_BIT_MASK(64))) |
814c01dc7 jme: Adding {64,4... |
2880 2881 2882 |
return 1; if (pdev->device == PCI_DEVICE_ID_JMICRON_JMC250 && |
e930438c4 Replace all DMA_n... |
2883 2884 |
!pci_set_dma_mask(pdev, DMA_BIT_MASK(40))) if (!pci_set_consistent_dma_mask(pdev, DMA_BIT_MASK(40))) |
814c01dc7 jme: Adding {64,4... |
2885 |
return 1; |
284901a90 dma-mapping: repl... |
2886 2887 |
if (!pci_set_dma_mask(pdev, DMA_BIT_MASK(32))) if (!pci_set_consistent_dma_mask(pdev, DMA_BIT_MASK(32))) |
95252236e jme: JMicron Giga... |
2888 2889 2890 2891 2892 2893 2894 2895 2896 2897 2898 2899 2900 2901 2902 2903 2904 2905 2906 2907 2908 2909 2910 |
return 0; return -1; } static inline void jme_phy_init(struct jme_adapter *jme) { u16 reg26; reg26 = jme_mdio_read(jme->dev, jme->mii_if.phy_id, 26); jme_mdio_write(jme->dev, jme->mii_if.phy_id, 26, reg26 | 0x1000); } static inline void jme_check_hw_ver(struct jme_adapter *jme) { u32 chipmode; chipmode = jread32(jme, JME_CHIPMODE); jme->fpgaver = (chipmode & CM_FPGAVER_MASK) >> CM_FPGAVER_SHIFT; jme->chiprev = (chipmode & CM_CHIPREV_MASK) >> CM_CHIPREV_SHIFT; |
19d96017d jme: Extract main... |
2911 2912 |
jme->chip_main_rev = jme->chiprev & 0xF; jme->chip_sub_rev = (jme->chiprev >> 4) & 0xF; |
95252236e jme: JMicron Giga... |
2913 |
} |
e48714baa jme: convert driv... |
2914 2915 2916 2917 |
static const struct net_device_ops jme_netdev_ops = { .ndo_open = jme_open, .ndo_stop = jme_close, .ndo_validate_addr = eth_validate_addr, |
334fbbb74 jme: Adding mii-t... |
2918 |
.ndo_do_ioctl = jme_ioctl, |
e48714baa jme: convert driv... |
2919 2920 |
.ndo_start_xmit = jme_start_xmit, .ndo_set_mac_address = jme_set_macaddr, |
afc4b13df net: remove use o... |
2921 |
.ndo_set_rx_mode = jme_set_multi, |
e48714baa jme: convert driv... |
2922 2923 |
.ndo_change_mtu = jme_change_mtu, .ndo_tx_timeout = jme_tx_timeout, |
d7b576545 jme: convert offl... |
2924 2925 |
.ndo_fix_features = jme_fix_features, .ndo_set_features = jme_set_features, |
ed36d7b25 jme: netpoll support |
2926 2927 2928 |
#ifdef CONFIG_NET_POLL_CONTROLLER .ndo_poll_controller = jme_netpoll, #endif |
e48714baa jme: convert driv... |
2929 |
}; |
af37557b1 jme: remove __dev... |
2930 |
static int |
95252236e jme: JMicron Giga... |
2931 2932 2933 2934 2935 2936 2937 2938 2939 2940 2941 2942 |
jme_init_one(struct pci_dev *pdev, const struct pci_device_id *ent) { int rc = 0, using_dac, i; struct net_device *netdev; struct jme_adapter *jme; u16 bmcr, bmsr; u32 apmc; /* * set up PCI device basics */ |
aac9453b6 net/ethernet/jme:... |
2943 2944 |
pci_disable_link_state(pdev, PCIE_LINK_STATE_L0S | PCIE_LINK_STATE_L1 | PCIE_LINK_STATE_CLKPM); |
95252236e jme: JMicron Giga... |
2945 2946 |
rc = pci_enable_device(pdev); if (rc) { |
49d70c485 drivers/net/jme: ... |
2947 2948 |
pr_err("Cannot enable PCI device "); |
95252236e jme: JMicron Giga... |
2949 2950 2951 2952 2953 |
goto err_out; } using_dac = jme_pci_dma64(pdev); if (using_dac < 0) { |
49d70c485 drivers/net/jme: ... |
2954 2955 |
pr_err("Cannot set PCI DMA Mask "); |
95252236e jme: JMicron Giga... |
2956 2957 2958 2959 2960 |
rc = -EIO; goto err_out_disable_pdev; } if (!(pci_resource_flags(pdev, 0) & IORESOURCE_MEM)) { |
49d70c485 drivers/net/jme: ... |
2961 2962 |
pr_err("No PCI resource region found "); |
95252236e jme: JMicron Giga... |
2963 2964 2965 2966 2967 2968 |
rc = -ENOMEM; goto err_out_disable_pdev; } rc = pci_request_regions(pdev, DRV_NAME); if (rc) { |
49d70c485 drivers/net/jme: ... |
2969 2970 |
pr_err("Cannot obtain PCI resource region "); |
95252236e jme: JMicron Giga... |
2971 2972 2973 2974 2975 2976 2977 2978 2979 2980 |
goto err_out_disable_pdev; } pci_set_master(pdev); /* * alloc and init net device */ netdev = alloc_etherdev(sizeof(*jme)); if (!netdev) { |
95252236e jme: JMicron Giga... |
2981 2982 2983 |
rc = -ENOMEM; goto err_out_release_regions; } |
e48714baa jme: convert driv... |
2984 |
netdev->netdev_ops = &jme_netdev_ops; |
95252236e jme: JMicron Giga... |
2985 |
netdev->ethtool_ops = &jme_ethtool_ops; |
95252236e jme: JMicron Giga... |
2986 |
netdev->watchdog_timeo = TX_TIMEOUT; |
d7b576545 jme: convert offl... |
2987 2988 2989 2990 2991 2992 |
netdev->hw_features = NETIF_F_IP_CSUM | NETIF_F_IPV6_CSUM | NETIF_F_SG | NETIF_F_TSO | NETIF_F_TSO6 | NETIF_F_RXCSUM; |
790326440 net: Fix too opti... |
2993 2994 |
netdev->features = NETIF_F_IP_CSUM | NETIF_F_IPV6_CSUM | |
95252236e jme: JMicron Giga... |
2995 2996 2997 |
NETIF_F_SG | NETIF_F_TSO | NETIF_F_TSO6 | |
f646968f8 net: vlan: rename... |
2998 2999 |
NETIF_F_HW_VLAN_CTAG_TX | NETIF_F_HW_VLAN_CTAG_RX; |
95252236e jme: JMicron Giga... |
3000 3001 3002 3003 3004 3005 3006 3007 3008 3009 3010 3011 3012 |
if (using_dac) netdev->features |= NETIF_F_HIGHDMA; SET_NETDEV_DEV(netdev, &pdev->dev); pci_set_drvdata(pdev, netdev); /* * init adapter info */ jme = netdev_priv(netdev); jme->pdev = pdev; jme->dev = netdev; jme->jme_rx = netif_rx; |
95252236e jme: JMicron Giga... |
3013 3014 3015 3016 3017 3018 3019 3020 3021 3022 3023 |
jme->old_mtu = netdev->mtu = 1500; jme->phylink = 0; jme->tx_ring_size = 1 << 10; jme->tx_ring_mask = jme->tx_ring_size - 1; jme->tx_wake_threshold = 1 << 9; jme->rx_ring_size = 1 << 9; jme->rx_ring_mask = jme->rx_ring_size - 1; jme->msg_enable = JME_DEF_MSG_ENABLE; jme->regs = ioremap(pci_resource_start(pdev, 0), pci_resource_len(pdev, 0)); if (!(jme->regs)) { |
49d70c485 drivers/net/jme: ... |
3024 3025 |
pr_err("Mapping PCI resource region error "); |
95252236e jme: JMicron Giga... |
3026 3027 3028 |
rc = -ENOMEM; goto err_out_free_netdev; } |
95252236e jme: JMicron Giga... |
3029 3030 3031 3032 3033 3034 3035 3036 |
if (no_pseudohp) { apmc = jread32(jme, JME_APMC) & ~JME_APMC_PSEUDO_HP_EN; jwrite32(jme, JME_APMC, apmc); } else if (force_pseudohp) { apmc = jread32(jme, JME_APMC) | JME_APMC_PSEUDO_HP_EN; jwrite32(jme, JME_APMC, apmc); } |
449cfcc1c jme: lower NAPI w... |
3037 |
NETIF_NAPI_SET(netdev, &jme->napi, jme_poll, NAPI_POLL_WEIGHT) |
95252236e jme: JMicron Giga... |
3038 3039 3040 3041 3042 3043 3044 3045 3046 3047 3048 |
spin_lock_init(&jme->phy_lock); spin_lock_init(&jme->macaddr_lock); spin_lock_init(&jme->rxmcs_lock); atomic_set(&jme->link_changing, 1); atomic_set(&jme->rx_cleaning, 1); atomic_set(&jme->tx_cleaning, 1); atomic_set(&jme->rx_empty, 1); tasklet_init(&jme->pcc_task, |
164165dad drivers/net: task... |
3049 |
jme_pcc_tasklet, |
95252236e jme: JMicron Giga... |
3050 |
(unsigned long) jme); |
95252236e jme: JMicron Giga... |
3051 3052 3053 3054 3055 3056 3057 |
jme->dpi.cur = PCC_P1; jme->reg_ghc = 0; jme->reg_rxcs = RXCS_DEFAULT; jme->reg_rxmcs = RXMCS_DEFAULT; jme->reg_txpfc = 0; jme->reg_pmcs = PMCS_MFEN; |
854a2e7c3 jme: Safer MAC pr... |
3058 |
jme->reg_gpreg1 = GPREG1_DEFAULT; |
d7b576545 jme: convert offl... |
3059 3060 3061 |
if (jme->reg_rxmcs & RXMCS_CHECKSUM) netdev->features |= NETIF_F_RXCSUM; |
95252236e jme: JMicron Giga... |
3062 3063 3064 3065 3066 3067 3068 3069 3070 3071 3072 3073 3074 3075 3076 3077 |
/* * Get Max Read Req Size from PCI Config Space */ pci_read_config_byte(pdev, PCI_DCSR_MRRS, &jme->mrrs); jme->mrrs &= PCI_DCSR_MRRS_MASK; switch (jme->mrrs) { case MRRS_128B: jme->reg_txcs = TXCS_DEFAULT | TXCS_DMASIZE_128B; break; case MRRS_256B: jme->reg_txcs = TXCS_DEFAULT | TXCS_DMASIZE_256B; break; default: jme->reg_txcs = TXCS_DEFAULT | TXCS_DMASIZE_512B; break; |
ee289b644 drivers/net: remo... |
3078 |
} |
95252236e jme: JMicron Giga... |
3079 3080 3081 3082 3083 3084 3085 3086 3087 3088 3089 3090 3091 3092 3093 3094 3095 3096 3097 |
/* * Must check before reset_mac_processor */ jme_check_hw_ver(jme); jme->mii_if.dev = netdev; if (jme->fpgaver) { jme->mii_if.phy_id = 0; for (i = 1 ; i < 32 ; ++i) { bmcr = jme_mdio_read(netdev, i, MII_BMCR); bmsr = jme_mdio_read(netdev, i, MII_BMSR); if (bmcr != 0xFFFFU && (bmcr != 0 || bmsr != 0)) { jme->mii_if.phy_id = i; break; } } if (!jme->mii_if.phy_id) { rc = -EIO; |
49d70c485 drivers/net/jme: ... |
3098 3099 3100 |
pr_err("Can not find phy_id "); goto err_out_unmap; |
95252236e jme: JMicron Giga... |
3101 3102 3103 3104 3105 3106 3107 3108 3109 3110 |
} jme->reg_ghc |= GHC_LINK_POLL; } else { jme->mii_if.phy_id = 1; } if (pdev->device == PCI_DEVICE_ID_JMICRON_JMC250) jme->mii_if.supports_gmii = true; else jme->mii_if.supports_gmii = false; |
334fbbb74 jme: Adding mii-t... |
3111 3112 |
jme->mii_if.phy_id_mask = 0x1F; jme->mii_if.reg_num_mask = 0x1F; |
95252236e jme: JMicron Giga... |
3113 3114 3115 3116 |
jme->mii_if.mdio_read = jme_mdio_read; jme->mii_if.mdio_write = jme_mdio_write; jme_clear_pm(jme); |
bc057e036 jme: Cleanup PM o... |
3117 |
device_set_wakeup_enable(&pdev->dev, true); |
517545723 jme: Rename phyfi... |
3118 |
jme_set_phyfifo_5level(jme); |
ff938e43d net: use pci_dev-... |
3119 |
jme->pcirev = pdev->revision; |
95252236e jme: JMicron Giga... |
3120 3121 3122 3123 3124 3125 3126 3127 3128 3129 |
if (!jme->fpgaver) jme_phy_init(jme); jme_phy_off(jme); /* * Reset MAC processor and reload EEPROM for MAC Address */ jme_reset_mac_processor(jme); rc = jme_reload_eeprom(jme); if (rc) { |
49d70c485 drivers/net/jme: ... |
3130 3131 |
pr_err("Reload eeprom for reading MAC Address error "); |
d1dfa1d1d jme: Remove shado... |
3132 |
goto err_out_unmap; |
95252236e jme: JMicron Giga... |
3133 3134 3135 3136 3137 3138 3139 |
} jme_load_macaddr(netdev); /* * Tell stack that we are not ready to work until open() */ netif_carrier_off(netdev); |
95252236e jme: JMicron Giga... |
3140 |
|
95252236e jme: JMicron Giga... |
3141 3142 |
rc = register_netdev(netdev); if (rc) { |
49d70c485 drivers/net/jme: ... |
3143 3144 |
pr_err("Cannot register net device "); |
d1dfa1d1d jme: Remove shado... |
3145 |
goto err_out_unmap; |
95252236e jme: JMicron Giga... |
3146 |
} |
19d96017d jme: Extract main... |
3147 3148 |
netif_info(jme, probe, jme->dev, "%s%s chiprev:%x pcirev:%x macaddr:%pM ", |
f8502ce4f drivers/net/jme: ... |
3149 3150 3151 3152 3153 3154 |
(jme->pdev->device == PCI_DEVICE_ID_JMICRON_JMC250) ? "JMC250 Gigabit Ethernet" : (jme->pdev->device == PCI_DEVICE_ID_JMICRON_JMC260) ? "JMC260 Fast Ethernet" : "Unknown", (jme->fpgaver != 0) ? " (FPGA)" : "", (jme->fpgaver != 0) ? jme->fpgaver : jme->chiprev, |
19d96017d jme: Extract main... |
3155 |
jme->pcirev, netdev->dev_addr); |
95252236e jme: JMicron Giga... |
3156 3157 |
return 0; |
95252236e jme: JMicron Giga... |
3158 3159 3160 |
err_out_unmap: iounmap(jme->regs); err_out_free_netdev: |
95252236e jme: JMicron Giga... |
3161 3162 3163 3164 3165 3166 3167 3168 |
free_netdev(netdev); err_out_release_regions: pci_release_regions(pdev); err_out_disable_pdev: pci_disable_device(pdev); err_out: return rc; } |
af37557b1 jme: remove __dev... |
3169 |
static void |
95252236e jme: JMicron Giga... |
3170 3171 3172 3173 3174 3175 |
jme_remove_one(struct pci_dev *pdev) { struct net_device *netdev = pci_get_drvdata(pdev); struct jme_adapter *jme = netdev_priv(netdev); unregister_netdev(netdev); |
95252236e jme: JMicron Giga... |
3176 |
iounmap(jme->regs); |
95252236e jme: JMicron Giga... |
3177 3178 3179 3180 3181 |
free_netdev(netdev); pci_release_regions(pdev); pci_disable_device(pdev); } |
1c5578194 jme: Support WoL ... |
3182 3183 3184 3185 3186 3187 3188 3189 3190 |
static void jme_shutdown(struct pci_dev *pdev) { struct net_device *netdev = pci_get_drvdata(pdev); struct jme_adapter *jme = netdev_priv(netdev); jme_powersave_phy(jme); pci_pme_active(pdev, true); } |
aab6fb82b jme: Fix compile ... |
3191 |
#ifdef CONFIG_PM_SLEEP |
bc057e036 jme: Cleanup PM o... |
3192 3193 |
static int jme_suspend(struct device *dev) |
95252236e jme: JMicron Giga... |
3194 |
{ |
f4e5bd4f5 Net / jme: Do not... |
3195 |
struct pci_dev *pdev = to_pci_dev(dev); |
95252236e jme: JMicron Giga... |
3196 3197 |
struct net_device *netdev = pci_get_drvdata(pdev); struct jme_adapter *jme = netdev_priv(netdev); |
a7d5b76d9 jme: fix irq stor... |
3198 3199 |
if (!netif_running(netdev)) return 0; |
95252236e jme: JMicron Giga... |
3200 3201 3202 3203 3204 3205 3206 3207 3208 |
atomic_dec(&jme->link_changing); netif_device_detach(netdev); netif_stop_queue(netdev); jme_stop_irq(jme); tasklet_disable(&jme->txclean_task); tasklet_disable(&jme->rxclean_task); tasklet_disable(&jme->rxempty_task); |
95252236e jme: JMicron Giga... |
3209 3210 3211 3212 3213 |
if (netif_carrier_ok(netdev)) { if (test_bit(JME_FLAG_POLL, &jme->flags)) jme_polling_mode(jme); jme_stop_pcc_timer(jme); |
95252236e jme: JMicron Giga... |
3214 3215 3216 3217 3218 3219 3220 3221 3222 3223 3224 3225 |
jme_disable_rx_engine(jme); jme_disable_tx_engine(jme); jme_reset_mac_processor(jme); jme_free_rx_resources(jme); jme_free_tx_resources(jme); netif_carrier_off(netdev); jme->phylink = 0; } tasklet_enable(&jme->txclean_task); tasklet_hi_enable(&jme->rxclean_task); tasklet_hi_enable(&jme->rxempty_task); |
1c5578194 jme: Support WoL ... |
3226 |
jme_powersave_phy(jme); |
95252236e jme: JMicron Giga... |
3227 3228 3229 |
return 0; } |
bc057e036 jme: Cleanup PM o... |
3230 3231 |
static int jme_resume(struct device *dev) |
95252236e jme: JMicron Giga... |
3232 |
{ |
f4e5bd4f5 Net / jme: Do not... |
3233 |
struct pci_dev *pdev = to_pci_dev(dev); |
95252236e jme: JMicron Giga... |
3234 3235 |
struct net_device *netdev = pci_get_drvdata(pdev); struct jme_adapter *jme = netdev_priv(netdev); |
a7d5b76d9 jme: fix irq stor... |
3236 3237 |
if (!netif_running(netdev)) return 0; |
bc057e036 jme: Cleanup PM o... |
3238 |
jme_clear_pm(jme); |
4872b11fd jme: PHY Power co... |
3239 3240 |
jme_phy_on(jme); if (test_bit(JME_FLAG_SSET, &jme->flags)) |
95252236e jme: JMicron Giga... |
3241 |
jme_set_settings(netdev, &jme->old_ecmd); |
4872b11fd jme: PHY Power co... |
3242 |
else |
95252236e jme: JMicron Giga... |
3243 |
jme_reset_phy_processor(jme); |
c4860ba2e jme: PHY configur... |
3244 3245 |
jme_phy_calibration(jme); jme_phy_setEA(jme); |
95252236e jme: JMicron Giga... |
3246 3247 3248 3249 3250 3251 3252 3253 3254 |
jme_start_irq(jme); netif_device_attach(netdev); atomic_inc(&jme->link_changing); jme_reset_link(jme); return 0; } |
f4e5bd4f5 Net / jme: Do not... |
3255 3256 3257 3258 3259 3260 3261 |
static SIMPLE_DEV_PM_OPS(jme_pm_ops, jme_suspend, jme_resume); #define JME_PM_OPS (&jme_pm_ops) #else #define JME_PM_OPS NULL |
724f88057 jme: Fix warnings... |
3262 |
#endif |
95252236e jme: JMicron Giga... |
3263 |
|
a3aa18842 drivers/net/: use... |
3264 |
static DEFINE_PCI_DEVICE_TABLE(jme_pci_tbl) = { |
95252236e jme: JMicron Giga... |
3265 3266 3267 3268 3269 3270 3271 3272 3273 |
{ PCI_VDEVICE(JMICRON, PCI_DEVICE_ID_JMICRON_JMC250) }, { PCI_VDEVICE(JMICRON, PCI_DEVICE_ID_JMICRON_JMC260) }, { } }; static struct pci_driver jme_driver = { .name = DRV_NAME, .id_table = jme_pci_tbl, .probe = jme_init_one, |
af37557b1 jme: remove __dev... |
3274 |
.remove = jme_remove_one, |
1c5578194 jme: Support WoL ... |
3275 |
.shutdown = jme_shutdown, |
f4e5bd4f5 Net / jme: Do not... |
3276 |
.driver.pm = JME_PM_OPS, |
95252236e jme: JMicron Giga... |
3277 3278 3279 3280 3281 |
}; static int __init jme_init_module(void) { |
49d70c485 drivers/net/jme: ... |
3282 3283 |
pr_info("JMicron JMC2XX ethernet driver version %s ", DRV_VERSION); |
95252236e jme: JMicron Giga... |
3284 3285 3286 3287 3288 3289 3290 3291 3292 3293 3294 3295 3296 3297 3298 3299 3300 |
return pci_register_driver(&jme_driver); } static void __exit jme_cleanup_module(void) { pci_unregister_driver(&jme_driver); } module_init(jme_init_module); module_exit(jme_cleanup_module); MODULE_AUTHOR("Guo-Fu Tseng <cooldavid@cooldavid.org>"); MODULE_DESCRIPTION("JMicron JMC2x0 PCI Express Ethernet driver"); MODULE_LICENSE("GPL"); MODULE_VERSION(DRV_VERSION); MODULE_DEVICE_TABLE(pci, jme_pci_tbl); |