1e689cf4aSJeff Kirsher /* $Id: sungem.c,v 1.44.2.22 2002/03/13 01:18:12 davem Exp $ 2e689cf4aSJeff Kirsher * sungem.c: Sun GEM ethernet driver. 3e689cf4aSJeff Kirsher * 4e689cf4aSJeff Kirsher * Copyright (C) 2000, 2001, 2002, 2003 David S. Miller (davem@redhat.com) 5e689cf4aSJeff Kirsher * 6e689cf4aSJeff Kirsher * Support for Apple GMAC and assorted PHYs, WOL, Power Management 7e689cf4aSJeff Kirsher * (C) 2001,2002,2003 Benjamin Herrenscmidt (benh@kernel.crashing.org) 8e689cf4aSJeff Kirsher * (C) 2004,2005 Benjamin Herrenscmidt, IBM Corp. 9e689cf4aSJeff Kirsher * 10e689cf4aSJeff Kirsher * NAPI and NETPOLL support 11e689cf4aSJeff Kirsher * (C) 2004 by Eric Lemoine (eric.lemoine@gmail.com) 12e689cf4aSJeff Kirsher * 13e689cf4aSJeff Kirsher */ 14e689cf4aSJeff Kirsher 15e689cf4aSJeff Kirsher #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt 16e689cf4aSJeff Kirsher 17e689cf4aSJeff Kirsher #include <linux/module.h> 18e689cf4aSJeff Kirsher #include <linux/kernel.h> 19e689cf4aSJeff Kirsher #include <linux/types.h> 20e689cf4aSJeff Kirsher #include <linux/fcntl.h> 21e689cf4aSJeff Kirsher #include <linux/interrupt.h> 22e689cf4aSJeff Kirsher #include <linux/ioport.h> 23e689cf4aSJeff Kirsher #include <linux/in.h> 24e689cf4aSJeff Kirsher #include <linux/sched.h> 25e689cf4aSJeff Kirsher #include <linux/string.h> 26e689cf4aSJeff Kirsher #include <linux/delay.h> 27e689cf4aSJeff Kirsher #include <linux/init.h> 28e689cf4aSJeff Kirsher #include <linux/errno.h> 29e689cf4aSJeff Kirsher #include <linux/pci.h> 30e689cf4aSJeff Kirsher #include <linux/dma-mapping.h> 31e689cf4aSJeff Kirsher #include <linux/netdevice.h> 32e689cf4aSJeff Kirsher #include <linux/etherdevice.h> 33e689cf4aSJeff Kirsher #include <linux/skbuff.h> 34e689cf4aSJeff Kirsher #include <linux/mii.h> 35e689cf4aSJeff Kirsher #include <linux/ethtool.h> 36e689cf4aSJeff Kirsher #include <linux/crc32.h> 37e689cf4aSJeff Kirsher #include <linux/random.h> 38e689cf4aSJeff Kirsher #include <linux/workqueue.h> 39e689cf4aSJeff Kirsher #include <linux/if_vlan.h> 40e689cf4aSJeff Kirsher #include <linux/bitops.h> 41e689cf4aSJeff Kirsher #include <linux/mm.h> 42e689cf4aSJeff Kirsher #include <linux/gfp.h> 43e689cf4aSJeff Kirsher 44e689cf4aSJeff Kirsher #include <asm/system.h> 45e689cf4aSJeff Kirsher #include <asm/io.h> 46e689cf4aSJeff Kirsher #include <asm/byteorder.h> 47e689cf4aSJeff Kirsher #include <asm/uaccess.h> 48e689cf4aSJeff Kirsher #include <asm/irq.h> 49e689cf4aSJeff Kirsher 50e689cf4aSJeff Kirsher #ifdef CONFIG_SPARC 51e689cf4aSJeff Kirsher #include <asm/idprom.h> 52e689cf4aSJeff Kirsher #include <asm/prom.h> 53e689cf4aSJeff Kirsher #endif 54e689cf4aSJeff Kirsher 55e689cf4aSJeff Kirsher #ifdef CONFIG_PPC_PMAC 56e689cf4aSJeff Kirsher #include <asm/pci-bridge.h> 57e689cf4aSJeff Kirsher #include <asm/prom.h> 58e689cf4aSJeff Kirsher #include <asm/machdep.h> 59e689cf4aSJeff Kirsher #include <asm/pmac_feature.h> 60e689cf4aSJeff Kirsher #endif 61e689cf4aSJeff Kirsher 622bb69841SDavid S. Miller #include <linux/sungem_phy.h> 63e689cf4aSJeff Kirsher #include "sungem.h" 64e689cf4aSJeff Kirsher 65e689cf4aSJeff Kirsher /* Stripping FCS is causing problems, disabled for now */ 66e689cf4aSJeff Kirsher #undef STRIP_FCS 67e689cf4aSJeff Kirsher 68e689cf4aSJeff Kirsher #define DEFAULT_MSG (NETIF_MSG_DRV | \ 69e689cf4aSJeff Kirsher NETIF_MSG_PROBE | \ 70e689cf4aSJeff Kirsher NETIF_MSG_LINK) 71e689cf4aSJeff Kirsher 72e689cf4aSJeff Kirsher #define ADVERTISE_MASK (SUPPORTED_10baseT_Half | SUPPORTED_10baseT_Full | \ 73e689cf4aSJeff Kirsher SUPPORTED_100baseT_Half | SUPPORTED_100baseT_Full | \ 74e689cf4aSJeff Kirsher SUPPORTED_1000baseT_Half | SUPPORTED_1000baseT_Full | \ 75e689cf4aSJeff Kirsher SUPPORTED_Pause | SUPPORTED_Autoneg) 76e689cf4aSJeff Kirsher 77e689cf4aSJeff Kirsher #define DRV_NAME "sungem" 78e689cf4aSJeff Kirsher #define DRV_VERSION "1.0" 79e689cf4aSJeff Kirsher #define DRV_AUTHOR "David S. Miller <davem@redhat.com>" 80e689cf4aSJeff Kirsher 81e689cf4aSJeff Kirsher static char version[] __devinitdata = 82e689cf4aSJeff Kirsher DRV_NAME ".c:v" DRV_VERSION " " DRV_AUTHOR "\n"; 83e689cf4aSJeff Kirsher 84e689cf4aSJeff Kirsher MODULE_AUTHOR(DRV_AUTHOR); 85e689cf4aSJeff Kirsher MODULE_DESCRIPTION("Sun GEM Gbit ethernet driver"); 86e689cf4aSJeff Kirsher MODULE_LICENSE("GPL"); 87e689cf4aSJeff Kirsher 88e689cf4aSJeff Kirsher #define GEM_MODULE_NAME "gem" 89e689cf4aSJeff Kirsher 90e689cf4aSJeff Kirsher static DEFINE_PCI_DEVICE_TABLE(gem_pci_tbl) = { 91e689cf4aSJeff Kirsher { PCI_VENDOR_ID_SUN, PCI_DEVICE_ID_SUN_GEM, 92e689cf4aSJeff Kirsher PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0UL }, 93e689cf4aSJeff Kirsher 94e689cf4aSJeff Kirsher /* These models only differ from the original GEM in 95e689cf4aSJeff Kirsher * that their tx/rx fifos are of a different size and 96e689cf4aSJeff Kirsher * they only support 10/100 speeds. -DaveM 97e689cf4aSJeff Kirsher * 98e689cf4aSJeff Kirsher * Apple's GMAC does support gigabit on machines with 99e689cf4aSJeff Kirsher * the BCM54xx PHYs. -BenH 100e689cf4aSJeff Kirsher */ 101e689cf4aSJeff Kirsher { PCI_VENDOR_ID_SUN, PCI_DEVICE_ID_SUN_RIO_GEM, 102e689cf4aSJeff Kirsher PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0UL }, 103e689cf4aSJeff Kirsher { PCI_VENDOR_ID_APPLE, PCI_DEVICE_ID_APPLE_UNI_N_GMAC, 104e689cf4aSJeff Kirsher PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0UL }, 105e689cf4aSJeff Kirsher { PCI_VENDOR_ID_APPLE, PCI_DEVICE_ID_APPLE_UNI_N_GMACP, 106e689cf4aSJeff Kirsher PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0UL }, 107e689cf4aSJeff Kirsher { PCI_VENDOR_ID_APPLE, PCI_DEVICE_ID_APPLE_UNI_N_GMAC2, 108e689cf4aSJeff Kirsher PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0UL }, 109e689cf4aSJeff Kirsher { PCI_VENDOR_ID_APPLE, PCI_DEVICE_ID_APPLE_K2_GMAC, 110e689cf4aSJeff Kirsher PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0UL }, 111e689cf4aSJeff Kirsher { PCI_VENDOR_ID_APPLE, PCI_DEVICE_ID_APPLE_SH_SUNGEM, 112e689cf4aSJeff Kirsher PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0UL }, 113e689cf4aSJeff Kirsher { PCI_VENDOR_ID_APPLE, PCI_DEVICE_ID_APPLE_IPID2_GMAC, 114e689cf4aSJeff Kirsher PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0UL }, 115e689cf4aSJeff Kirsher {0, } 116e689cf4aSJeff Kirsher }; 117e689cf4aSJeff Kirsher 118e689cf4aSJeff Kirsher MODULE_DEVICE_TABLE(pci, gem_pci_tbl); 119e689cf4aSJeff Kirsher 120e689cf4aSJeff Kirsher static u16 __phy_read(struct gem *gp, int phy_addr, int reg) 121e689cf4aSJeff Kirsher { 122e689cf4aSJeff Kirsher u32 cmd; 123e689cf4aSJeff Kirsher int limit = 10000; 124e689cf4aSJeff Kirsher 125e689cf4aSJeff Kirsher cmd = (1 << 30); 126e689cf4aSJeff Kirsher cmd |= (2 << 28); 127e689cf4aSJeff Kirsher cmd |= (phy_addr << 23) & MIF_FRAME_PHYAD; 128e689cf4aSJeff Kirsher cmd |= (reg << 18) & MIF_FRAME_REGAD; 129e689cf4aSJeff Kirsher cmd |= (MIF_FRAME_TAMSB); 130e689cf4aSJeff Kirsher writel(cmd, gp->regs + MIF_FRAME); 131e689cf4aSJeff Kirsher 132e689cf4aSJeff Kirsher while (--limit) { 133e689cf4aSJeff Kirsher cmd = readl(gp->regs + MIF_FRAME); 134e689cf4aSJeff Kirsher if (cmd & MIF_FRAME_TALSB) 135e689cf4aSJeff Kirsher break; 136e689cf4aSJeff Kirsher 137e689cf4aSJeff Kirsher udelay(10); 138e689cf4aSJeff Kirsher } 139e689cf4aSJeff Kirsher 140e689cf4aSJeff Kirsher if (!limit) 141e689cf4aSJeff Kirsher cmd = 0xffff; 142e689cf4aSJeff Kirsher 143e689cf4aSJeff Kirsher return cmd & MIF_FRAME_DATA; 144e689cf4aSJeff Kirsher } 145e689cf4aSJeff Kirsher 146e689cf4aSJeff Kirsher static inline int _phy_read(struct net_device *dev, int mii_id, int reg) 147e689cf4aSJeff Kirsher { 148e689cf4aSJeff Kirsher struct gem *gp = netdev_priv(dev); 149e689cf4aSJeff Kirsher return __phy_read(gp, mii_id, reg); 150e689cf4aSJeff Kirsher } 151e689cf4aSJeff Kirsher 152e689cf4aSJeff Kirsher static inline u16 phy_read(struct gem *gp, int reg) 153e689cf4aSJeff Kirsher { 154e689cf4aSJeff Kirsher return __phy_read(gp, gp->mii_phy_addr, reg); 155e689cf4aSJeff Kirsher } 156e689cf4aSJeff Kirsher 157e689cf4aSJeff Kirsher static void __phy_write(struct gem *gp, int phy_addr, int reg, u16 val) 158e689cf4aSJeff Kirsher { 159e689cf4aSJeff Kirsher u32 cmd; 160e689cf4aSJeff Kirsher int limit = 10000; 161e689cf4aSJeff Kirsher 162e689cf4aSJeff Kirsher cmd = (1 << 30); 163e689cf4aSJeff Kirsher cmd |= (1 << 28); 164e689cf4aSJeff Kirsher cmd |= (phy_addr << 23) & MIF_FRAME_PHYAD; 165e689cf4aSJeff Kirsher cmd |= (reg << 18) & MIF_FRAME_REGAD; 166e689cf4aSJeff Kirsher cmd |= (MIF_FRAME_TAMSB); 167e689cf4aSJeff Kirsher cmd |= (val & MIF_FRAME_DATA); 168e689cf4aSJeff Kirsher writel(cmd, gp->regs + MIF_FRAME); 169e689cf4aSJeff Kirsher 170e689cf4aSJeff Kirsher while (limit--) { 171e689cf4aSJeff Kirsher cmd = readl(gp->regs + MIF_FRAME); 172e689cf4aSJeff Kirsher if (cmd & MIF_FRAME_TALSB) 173e689cf4aSJeff Kirsher break; 174e689cf4aSJeff Kirsher 175e689cf4aSJeff Kirsher udelay(10); 176e689cf4aSJeff Kirsher } 177e689cf4aSJeff Kirsher } 178e689cf4aSJeff Kirsher 179e689cf4aSJeff Kirsher static inline void _phy_write(struct net_device *dev, int mii_id, int reg, int val) 180e689cf4aSJeff Kirsher { 181e689cf4aSJeff Kirsher struct gem *gp = netdev_priv(dev); 182e689cf4aSJeff Kirsher __phy_write(gp, mii_id, reg, val & 0xffff); 183e689cf4aSJeff Kirsher } 184e689cf4aSJeff Kirsher 185e689cf4aSJeff Kirsher static inline void phy_write(struct gem *gp, int reg, u16 val) 186e689cf4aSJeff Kirsher { 187e689cf4aSJeff Kirsher __phy_write(gp, gp->mii_phy_addr, reg, val); 188e689cf4aSJeff Kirsher } 189e689cf4aSJeff Kirsher 190e689cf4aSJeff Kirsher static inline void gem_enable_ints(struct gem *gp) 191e689cf4aSJeff Kirsher { 192e689cf4aSJeff Kirsher /* Enable all interrupts but TXDONE */ 193e689cf4aSJeff Kirsher writel(GREG_STAT_TXDONE, gp->regs + GREG_IMASK); 194e689cf4aSJeff Kirsher } 195e689cf4aSJeff Kirsher 196e689cf4aSJeff Kirsher static inline void gem_disable_ints(struct gem *gp) 197e689cf4aSJeff Kirsher { 198e689cf4aSJeff Kirsher /* Disable all interrupts, including TXDONE */ 199e689cf4aSJeff Kirsher writel(GREG_STAT_NAPI | GREG_STAT_TXDONE, gp->regs + GREG_IMASK); 200e689cf4aSJeff Kirsher (void)readl(gp->regs + GREG_IMASK); /* write posting */ 201e689cf4aSJeff Kirsher } 202e689cf4aSJeff Kirsher 203e689cf4aSJeff Kirsher static void gem_get_cell(struct gem *gp) 204e689cf4aSJeff Kirsher { 205e689cf4aSJeff Kirsher BUG_ON(gp->cell_enabled < 0); 206e689cf4aSJeff Kirsher gp->cell_enabled++; 207e689cf4aSJeff Kirsher #ifdef CONFIG_PPC_PMAC 208e689cf4aSJeff Kirsher if (gp->cell_enabled == 1) { 209e689cf4aSJeff Kirsher mb(); 210e689cf4aSJeff Kirsher pmac_call_feature(PMAC_FTR_GMAC_ENABLE, gp->of_node, 0, 1); 211e689cf4aSJeff Kirsher udelay(10); 212e689cf4aSJeff Kirsher } 213e689cf4aSJeff Kirsher #endif /* CONFIG_PPC_PMAC */ 214e689cf4aSJeff Kirsher } 215e689cf4aSJeff Kirsher 216e689cf4aSJeff Kirsher /* Turn off the chip's clock */ 217e689cf4aSJeff Kirsher static void gem_put_cell(struct gem *gp) 218e689cf4aSJeff Kirsher { 219e689cf4aSJeff Kirsher BUG_ON(gp->cell_enabled <= 0); 220e689cf4aSJeff Kirsher gp->cell_enabled--; 221e689cf4aSJeff Kirsher #ifdef CONFIG_PPC_PMAC 222e689cf4aSJeff Kirsher if (gp->cell_enabled == 0) { 223e689cf4aSJeff Kirsher mb(); 224e689cf4aSJeff Kirsher pmac_call_feature(PMAC_FTR_GMAC_ENABLE, gp->of_node, 0, 0); 225e689cf4aSJeff Kirsher udelay(10); 226e689cf4aSJeff Kirsher } 227e689cf4aSJeff Kirsher #endif /* CONFIG_PPC_PMAC */ 228e689cf4aSJeff Kirsher } 229e689cf4aSJeff Kirsher 230e689cf4aSJeff Kirsher static inline void gem_netif_stop(struct gem *gp) 231e689cf4aSJeff Kirsher { 232e689cf4aSJeff Kirsher gp->dev->trans_start = jiffies; /* prevent tx timeout */ 233e689cf4aSJeff Kirsher napi_disable(&gp->napi); 234e689cf4aSJeff Kirsher netif_tx_disable(gp->dev); 235e689cf4aSJeff Kirsher } 236e689cf4aSJeff Kirsher 237e689cf4aSJeff Kirsher static inline void gem_netif_start(struct gem *gp) 238e689cf4aSJeff Kirsher { 239e689cf4aSJeff Kirsher /* NOTE: unconditional netif_wake_queue is only 240e689cf4aSJeff Kirsher * appropriate so long as all callers are assured to 241e689cf4aSJeff Kirsher * have free tx slots. 242e689cf4aSJeff Kirsher */ 243e689cf4aSJeff Kirsher netif_wake_queue(gp->dev); 244e689cf4aSJeff Kirsher napi_enable(&gp->napi); 245e689cf4aSJeff Kirsher } 246e689cf4aSJeff Kirsher 247e689cf4aSJeff Kirsher static void gem_schedule_reset(struct gem *gp) 248e689cf4aSJeff Kirsher { 249e689cf4aSJeff Kirsher gp->reset_task_pending = 1; 250e689cf4aSJeff Kirsher schedule_work(&gp->reset_task); 251e689cf4aSJeff Kirsher } 252e689cf4aSJeff Kirsher 253e689cf4aSJeff Kirsher static void gem_handle_mif_event(struct gem *gp, u32 reg_val, u32 changed_bits) 254e689cf4aSJeff Kirsher { 255e689cf4aSJeff Kirsher if (netif_msg_intr(gp)) 256e689cf4aSJeff Kirsher printk(KERN_DEBUG "%s: mif interrupt\n", gp->dev->name); 257e689cf4aSJeff Kirsher } 258e689cf4aSJeff Kirsher 259e689cf4aSJeff Kirsher static int gem_pcs_interrupt(struct net_device *dev, struct gem *gp, u32 gem_status) 260e689cf4aSJeff Kirsher { 261e689cf4aSJeff Kirsher u32 pcs_istat = readl(gp->regs + PCS_ISTAT); 262e689cf4aSJeff Kirsher u32 pcs_miistat; 263e689cf4aSJeff Kirsher 264e689cf4aSJeff Kirsher if (netif_msg_intr(gp)) 265e689cf4aSJeff Kirsher printk(KERN_DEBUG "%s: pcs interrupt, pcs_istat: 0x%x\n", 266e689cf4aSJeff Kirsher gp->dev->name, pcs_istat); 267e689cf4aSJeff Kirsher 268e689cf4aSJeff Kirsher if (!(pcs_istat & PCS_ISTAT_LSC)) { 269e689cf4aSJeff Kirsher netdev_err(dev, "PCS irq but no link status change???\n"); 270e689cf4aSJeff Kirsher return 0; 271e689cf4aSJeff Kirsher } 272e689cf4aSJeff Kirsher 273e689cf4aSJeff Kirsher /* The link status bit latches on zero, so you must 274e689cf4aSJeff Kirsher * read it twice in such a case to see a transition 275e689cf4aSJeff Kirsher * to the link being up. 276e689cf4aSJeff Kirsher */ 277e689cf4aSJeff Kirsher pcs_miistat = readl(gp->regs + PCS_MIISTAT); 278e689cf4aSJeff Kirsher if (!(pcs_miistat & PCS_MIISTAT_LS)) 279e689cf4aSJeff Kirsher pcs_miistat |= 280e689cf4aSJeff Kirsher (readl(gp->regs + PCS_MIISTAT) & 281e689cf4aSJeff Kirsher PCS_MIISTAT_LS); 282e689cf4aSJeff Kirsher 283e689cf4aSJeff Kirsher if (pcs_miistat & PCS_MIISTAT_ANC) { 284e689cf4aSJeff Kirsher /* The remote-fault indication is only valid 285e689cf4aSJeff Kirsher * when autoneg has completed. 286e689cf4aSJeff Kirsher */ 287e689cf4aSJeff Kirsher if (pcs_miistat & PCS_MIISTAT_RF) 288e689cf4aSJeff Kirsher netdev_info(dev, "PCS AutoNEG complete, RemoteFault\n"); 289e689cf4aSJeff Kirsher else 290e689cf4aSJeff Kirsher netdev_info(dev, "PCS AutoNEG complete\n"); 291e689cf4aSJeff Kirsher } 292e689cf4aSJeff Kirsher 293e689cf4aSJeff Kirsher if (pcs_miistat & PCS_MIISTAT_LS) { 294e689cf4aSJeff Kirsher netdev_info(dev, "PCS link is now up\n"); 295e689cf4aSJeff Kirsher netif_carrier_on(gp->dev); 296e689cf4aSJeff Kirsher } else { 297e689cf4aSJeff Kirsher netdev_info(dev, "PCS link is now down\n"); 298e689cf4aSJeff Kirsher netif_carrier_off(gp->dev); 299e689cf4aSJeff Kirsher /* If this happens and the link timer is not running, 300e689cf4aSJeff Kirsher * reset so we re-negotiate. 301e689cf4aSJeff Kirsher */ 302e689cf4aSJeff Kirsher if (!timer_pending(&gp->link_timer)) 303e689cf4aSJeff Kirsher return 1; 304e689cf4aSJeff Kirsher } 305e689cf4aSJeff Kirsher 306e689cf4aSJeff Kirsher return 0; 307e689cf4aSJeff Kirsher } 308e689cf4aSJeff Kirsher 309e689cf4aSJeff Kirsher static int gem_txmac_interrupt(struct net_device *dev, struct gem *gp, u32 gem_status) 310e689cf4aSJeff Kirsher { 311e689cf4aSJeff Kirsher u32 txmac_stat = readl(gp->regs + MAC_TXSTAT); 312e689cf4aSJeff Kirsher 313e689cf4aSJeff Kirsher if (netif_msg_intr(gp)) 314e689cf4aSJeff Kirsher printk(KERN_DEBUG "%s: txmac interrupt, txmac_stat: 0x%x\n", 315e689cf4aSJeff Kirsher gp->dev->name, txmac_stat); 316e689cf4aSJeff Kirsher 317e689cf4aSJeff Kirsher /* Defer timer expiration is quite normal, 318e689cf4aSJeff Kirsher * don't even log the event. 319e689cf4aSJeff Kirsher */ 320e689cf4aSJeff Kirsher if ((txmac_stat & MAC_TXSTAT_DTE) && 321e689cf4aSJeff Kirsher !(txmac_stat & ~MAC_TXSTAT_DTE)) 322e689cf4aSJeff Kirsher return 0; 323e689cf4aSJeff Kirsher 324e689cf4aSJeff Kirsher if (txmac_stat & MAC_TXSTAT_URUN) { 325e689cf4aSJeff Kirsher netdev_err(dev, "TX MAC xmit underrun\n"); 326e689cf4aSJeff Kirsher dev->stats.tx_fifo_errors++; 327e689cf4aSJeff Kirsher } 328e689cf4aSJeff Kirsher 329e689cf4aSJeff Kirsher if (txmac_stat & MAC_TXSTAT_MPE) { 330e689cf4aSJeff Kirsher netdev_err(dev, "TX MAC max packet size error\n"); 331e689cf4aSJeff Kirsher dev->stats.tx_errors++; 332e689cf4aSJeff Kirsher } 333e689cf4aSJeff Kirsher 334e689cf4aSJeff Kirsher /* The rest are all cases of one of the 16-bit TX 335e689cf4aSJeff Kirsher * counters expiring. 336e689cf4aSJeff Kirsher */ 337e689cf4aSJeff Kirsher if (txmac_stat & MAC_TXSTAT_NCE) 338e689cf4aSJeff Kirsher dev->stats.collisions += 0x10000; 339e689cf4aSJeff Kirsher 340e689cf4aSJeff Kirsher if (txmac_stat & MAC_TXSTAT_ECE) { 341e689cf4aSJeff Kirsher dev->stats.tx_aborted_errors += 0x10000; 342e689cf4aSJeff Kirsher dev->stats.collisions += 0x10000; 343e689cf4aSJeff Kirsher } 344e689cf4aSJeff Kirsher 345e689cf4aSJeff Kirsher if (txmac_stat & MAC_TXSTAT_LCE) { 346e689cf4aSJeff Kirsher dev->stats.tx_aborted_errors += 0x10000; 347e689cf4aSJeff Kirsher dev->stats.collisions += 0x10000; 348e689cf4aSJeff Kirsher } 349e689cf4aSJeff Kirsher 350e689cf4aSJeff Kirsher /* We do not keep track of MAC_TXSTAT_FCE and 351e689cf4aSJeff Kirsher * MAC_TXSTAT_PCE events. 352e689cf4aSJeff Kirsher */ 353e689cf4aSJeff Kirsher return 0; 354e689cf4aSJeff Kirsher } 355e689cf4aSJeff Kirsher 356e689cf4aSJeff Kirsher /* When we get a RX fifo overflow, the RX unit in GEM is probably hung 357e689cf4aSJeff Kirsher * so we do the following. 358e689cf4aSJeff Kirsher * 359e689cf4aSJeff Kirsher * If any part of the reset goes wrong, we return 1 and that causes the 360e689cf4aSJeff Kirsher * whole chip to be reset. 361e689cf4aSJeff Kirsher */ 362e689cf4aSJeff Kirsher static int gem_rxmac_reset(struct gem *gp) 363e689cf4aSJeff Kirsher { 364e689cf4aSJeff Kirsher struct net_device *dev = gp->dev; 365e689cf4aSJeff Kirsher int limit, i; 366e689cf4aSJeff Kirsher u64 desc_dma; 367e689cf4aSJeff Kirsher u32 val; 368e689cf4aSJeff Kirsher 369e689cf4aSJeff Kirsher /* First, reset & disable MAC RX. */ 370e689cf4aSJeff Kirsher writel(MAC_RXRST_CMD, gp->regs + MAC_RXRST); 371e689cf4aSJeff Kirsher for (limit = 0; limit < 5000; limit++) { 372e689cf4aSJeff Kirsher if (!(readl(gp->regs + MAC_RXRST) & MAC_RXRST_CMD)) 373e689cf4aSJeff Kirsher break; 374e689cf4aSJeff Kirsher udelay(10); 375e689cf4aSJeff Kirsher } 376e689cf4aSJeff Kirsher if (limit == 5000) { 377e689cf4aSJeff Kirsher netdev_err(dev, "RX MAC will not reset, resetting whole chip\n"); 378e689cf4aSJeff Kirsher return 1; 379e689cf4aSJeff Kirsher } 380e689cf4aSJeff Kirsher 381e689cf4aSJeff Kirsher writel(gp->mac_rx_cfg & ~MAC_RXCFG_ENAB, 382e689cf4aSJeff Kirsher gp->regs + MAC_RXCFG); 383e689cf4aSJeff Kirsher for (limit = 0; limit < 5000; limit++) { 384e689cf4aSJeff Kirsher if (!(readl(gp->regs + MAC_RXCFG) & MAC_RXCFG_ENAB)) 385e689cf4aSJeff Kirsher break; 386e689cf4aSJeff Kirsher udelay(10); 387e689cf4aSJeff Kirsher } 388e689cf4aSJeff Kirsher if (limit == 5000) { 389e689cf4aSJeff Kirsher netdev_err(dev, "RX MAC will not disable, resetting whole chip\n"); 390e689cf4aSJeff Kirsher return 1; 391e689cf4aSJeff Kirsher } 392e689cf4aSJeff Kirsher 393e689cf4aSJeff Kirsher /* Second, disable RX DMA. */ 394e689cf4aSJeff Kirsher writel(0, gp->regs + RXDMA_CFG); 395e689cf4aSJeff Kirsher for (limit = 0; limit < 5000; limit++) { 396e689cf4aSJeff Kirsher if (!(readl(gp->regs + RXDMA_CFG) & RXDMA_CFG_ENABLE)) 397e689cf4aSJeff Kirsher break; 398e689cf4aSJeff Kirsher udelay(10); 399e689cf4aSJeff Kirsher } 400e689cf4aSJeff Kirsher if (limit == 5000) { 401e689cf4aSJeff Kirsher netdev_err(dev, "RX DMA will not disable, resetting whole chip\n"); 402e689cf4aSJeff Kirsher return 1; 403e689cf4aSJeff Kirsher } 404e689cf4aSJeff Kirsher 405e689cf4aSJeff Kirsher udelay(5000); 406e689cf4aSJeff Kirsher 407e689cf4aSJeff Kirsher /* Execute RX reset command. */ 408e689cf4aSJeff Kirsher writel(gp->swrst_base | GREG_SWRST_RXRST, 409e689cf4aSJeff Kirsher gp->regs + GREG_SWRST); 410e689cf4aSJeff Kirsher for (limit = 0; limit < 5000; limit++) { 411e689cf4aSJeff Kirsher if (!(readl(gp->regs + GREG_SWRST) & GREG_SWRST_RXRST)) 412e689cf4aSJeff Kirsher break; 413e689cf4aSJeff Kirsher udelay(10); 414e689cf4aSJeff Kirsher } 415e689cf4aSJeff Kirsher if (limit == 5000) { 416e689cf4aSJeff Kirsher netdev_err(dev, "RX reset command will not execute, resetting whole chip\n"); 417e689cf4aSJeff Kirsher return 1; 418e689cf4aSJeff Kirsher } 419e689cf4aSJeff Kirsher 420e689cf4aSJeff Kirsher /* Refresh the RX ring. */ 421e689cf4aSJeff Kirsher for (i = 0; i < RX_RING_SIZE; i++) { 422e689cf4aSJeff Kirsher struct gem_rxd *rxd = &gp->init_block->rxd[i]; 423e689cf4aSJeff Kirsher 424e689cf4aSJeff Kirsher if (gp->rx_skbs[i] == NULL) { 425e689cf4aSJeff Kirsher netdev_err(dev, "Parts of RX ring empty, resetting whole chip\n"); 426e689cf4aSJeff Kirsher return 1; 427e689cf4aSJeff Kirsher } 428e689cf4aSJeff Kirsher 429e689cf4aSJeff Kirsher rxd->status_word = cpu_to_le64(RXDCTRL_FRESH(gp)); 430e689cf4aSJeff Kirsher } 431e689cf4aSJeff Kirsher gp->rx_new = gp->rx_old = 0; 432e689cf4aSJeff Kirsher 433e689cf4aSJeff Kirsher /* Now we must reprogram the rest of RX unit. */ 434e689cf4aSJeff Kirsher desc_dma = (u64) gp->gblock_dvma; 435e689cf4aSJeff Kirsher desc_dma += (INIT_BLOCK_TX_RING_SIZE * sizeof(struct gem_txd)); 436e689cf4aSJeff Kirsher writel(desc_dma >> 32, gp->regs + RXDMA_DBHI); 437e689cf4aSJeff Kirsher writel(desc_dma & 0xffffffff, gp->regs + RXDMA_DBLOW); 438e689cf4aSJeff Kirsher writel(RX_RING_SIZE - 4, gp->regs + RXDMA_KICK); 439e689cf4aSJeff Kirsher val = (RXDMA_CFG_BASE | (RX_OFFSET << 10) | 440e689cf4aSJeff Kirsher ((14 / 2) << 13) | RXDMA_CFG_FTHRESH_128); 441e689cf4aSJeff Kirsher writel(val, gp->regs + RXDMA_CFG); 442e689cf4aSJeff Kirsher if (readl(gp->regs + GREG_BIFCFG) & GREG_BIFCFG_M66EN) 443e689cf4aSJeff Kirsher writel(((5 & RXDMA_BLANK_IPKTS) | 444e689cf4aSJeff Kirsher ((8 << 12) & RXDMA_BLANK_ITIME)), 445e689cf4aSJeff Kirsher gp->regs + RXDMA_BLANK); 446e689cf4aSJeff Kirsher else 447e689cf4aSJeff Kirsher writel(((5 & RXDMA_BLANK_IPKTS) | 448e689cf4aSJeff Kirsher ((4 << 12) & RXDMA_BLANK_ITIME)), 449e689cf4aSJeff Kirsher gp->regs + RXDMA_BLANK); 450e689cf4aSJeff Kirsher val = (((gp->rx_pause_off / 64) << 0) & RXDMA_PTHRESH_OFF); 451e689cf4aSJeff Kirsher val |= (((gp->rx_pause_on / 64) << 12) & RXDMA_PTHRESH_ON); 452e689cf4aSJeff Kirsher writel(val, gp->regs + RXDMA_PTHRESH); 453e689cf4aSJeff Kirsher val = readl(gp->regs + RXDMA_CFG); 454e689cf4aSJeff Kirsher writel(val | RXDMA_CFG_ENABLE, gp->regs + RXDMA_CFG); 455e689cf4aSJeff Kirsher writel(MAC_RXSTAT_RCV, gp->regs + MAC_RXMASK); 456e689cf4aSJeff Kirsher val = readl(gp->regs + MAC_RXCFG); 457e689cf4aSJeff Kirsher writel(val | MAC_RXCFG_ENAB, gp->regs + MAC_RXCFG); 458e689cf4aSJeff Kirsher 459e689cf4aSJeff Kirsher return 0; 460e689cf4aSJeff Kirsher } 461e689cf4aSJeff Kirsher 462e689cf4aSJeff Kirsher static int gem_rxmac_interrupt(struct net_device *dev, struct gem *gp, u32 gem_status) 463e689cf4aSJeff Kirsher { 464e689cf4aSJeff Kirsher u32 rxmac_stat = readl(gp->regs + MAC_RXSTAT); 465e689cf4aSJeff Kirsher int ret = 0; 466e689cf4aSJeff Kirsher 467e689cf4aSJeff Kirsher if (netif_msg_intr(gp)) 468e689cf4aSJeff Kirsher printk(KERN_DEBUG "%s: rxmac interrupt, rxmac_stat: 0x%x\n", 469e689cf4aSJeff Kirsher gp->dev->name, rxmac_stat); 470e689cf4aSJeff Kirsher 471e689cf4aSJeff Kirsher if (rxmac_stat & MAC_RXSTAT_OFLW) { 472e689cf4aSJeff Kirsher u32 smac = readl(gp->regs + MAC_SMACHINE); 473e689cf4aSJeff Kirsher 474e689cf4aSJeff Kirsher netdev_err(dev, "RX MAC fifo overflow smac[%08x]\n", smac); 475e689cf4aSJeff Kirsher dev->stats.rx_over_errors++; 476e689cf4aSJeff Kirsher dev->stats.rx_fifo_errors++; 477e689cf4aSJeff Kirsher 478e689cf4aSJeff Kirsher ret = gem_rxmac_reset(gp); 479e689cf4aSJeff Kirsher } 480e689cf4aSJeff Kirsher 481e689cf4aSJeff Kirsher if (rxmac_stat & MAC_RXSTAT_ACE) 482e689cf4aSJeff Kirsher dev->stats.rx_frame_errors += 0x10000; 483e689cf4aSJeff Kirsher 484e689cf4aSJeff Kirsher if (rxmac_stat & MAC_RXSTAT_CCE) 485e689cf4aSJeff Kirsher dev->stats.rx_crc_errors += 0x10000; 486e689cf4aSJeff Kirsher 487e689cf4aSJeff Kirsher if (rxmac_stat & MAC_RXSTAT_LCE) 488e689cf4aSJeff Kirsher dev->stats.rx_length_errors += 0x10000; 489e689cf4aSJeff Kirsher 490e689cf4aSJeff Kirsher /* We do not track MAC_RXSTAT_FCE and MAC_RXSTAT_VCE 491e689cf4aSJeff Kirsher * events. 492e689cf4aSJeff Kirsher */ 493e689cf4aSJeff Kirsher return ret; 494e689cf4aSJeff Kirsher } 495e689cf4aSJeff Kirsher 496e689cf4aSJeff Kirsher static int gem_mac_interrupt(struct net_device *dev, struct gem *gp, u32 gem_status) 497e689cf4aSJeff Kirsher { 498e689cf4aSJeff Kirsher u32 mac_cstat = readl(gp->regs + MAC_CSTAT); 499e689cf4aSJeff Kirsher 500e689cf4aSJeff Kirsher if (netif_msg_intr(gp)) 501e689cf4aSJeff Kirsher printk(KERN_DEBUG "%s: mac interrupt, mac_cstat: 0x%x\n", 502e689cf4aSJeff Kirsher gp->dev->name, mac_cstat); 503e689cf4aSJeff Kirsher 504e689cf4aSJeff Kirsher /* This interrupt is just for pause frame and pause 505e689cf4aSJeff Kirsher * tracking. It is useful for diagnostics and debug 506e689cf4aSJeff Kirsher * but probably by default we will mask these events. 507e689cf4aSJeff Kirsher */ 508e689cf4aSJeff Kirsher if (mac_cstat & MAC_CSTAT_PS) 509e689cf4aSJeff Kirsher gp->pause_entered++; 510e689cf4aSJeff Kirsher 511e689cf4aSJeff Kirsher if (mac_cstat & MAC_CSTAT_PRCV) 512e689cf4aSJeff Kirsher gp->pause_last_time_recvd = (mac_cstat >> 16); 513e689cf4aSJeff Kirsher 514e689cf4aSJeff Kirsher return 0; 515e689cf4aSJeff Kirsher } 516e689cf4aSJeff Kirsher 517e689cf4aSJeff Kirsher static int gem_mif_interrupt(struct net_device *dev, struct gem *gp, u32 gem_status) 518e689cf4aSJeff Kirsher { 519e689cf4aSJeff Kirsher u32 mif_status = readl(gp->regs + MIF_STATUS); 520e689cf4aSJeff Kirsher u32 reg_val, changed_bits; 521e689cf4aSJeff Kirsher 522e689cf4aSJeff Kirsher reg_val = (mif_status & MIF_STATUS_DATA) >> 16; 523e689cf4aSJeff Kirsher changed_bits = (mif_status & MIF_STATUS_STAT); 524e689cf4aSJeff Kirsher 525e689cf4aSJeff Kirsher gem_handle_mif_event(gp, reg_val, changed_bits); 526e689cf4aSJeff Kirsher 527e689cf4aSJeff Kirsher return 0; 528e689cf4aSJeff Kirsher } 529e689cf4aSJeff Kirsher 530e689cf4aSJeff Kirsher static int gem_pci_interrupt(struct net_device *dev, struct gem *gp, u32 gem_status) 531e689cf4aSJeff Kirsher { 532e689cf4aSJeff Kirsher u32 pci_estat = readl(gp->regs + GREG_PCIESTAT); 533e689cf4aSJeff Kirsher 534e689cf4aSJeff Kirsher if (gp->pdev->vendor == PCI_VENDOR_ID_SUN && 535e689cf4aSJeff Kirsher gp->pdev->device == PCI_DEVICE_ID_SUN_GEM) { 536e689cf4aSJeff Kirsher netdev_err(dev, "PCI error [%04x]", pci_estat); 537e689cf4aSJeff Kirsher 538e689cf4aSJeff Kirsher if (pci_estat & GREG_PCIESTAT_BADACK) 539e689cf4aSJeff Kirsher pr_cont(" <No ACK64# during ABS64 cycle>"); 540e689cf4aSJeff Kirsher if (pci_estat & GREG_PCIESTAT_DTRTO) 541e689cf4aSJeff Kirsher pr_cont(" <Delayed transaction timeout>"); 542e689cf4aSJeff Kirsher if (pci_estat & GREG_PCIESTAT_OTHER) 543e689cf4aSJeff Kirsher pr_cont(" <other>"); 544e689cf4aSJeff Kirsher pr_cont("\n"); 545e689cf4aSJeff Kirsher } else { 546e689cf4aSJeff Kirsher pci_estat |= GREG_PCIESTAT_OTHER; 547e689cf4aSJeff Kirsher netdev_err(dev, "PCI error\n"); 548e689cf4aSJeff Kirsher } 549e689cf4aSJeff Kirsher 550e689cf4aSJeff Kirsher if (pci_estat & GREG_PCIESTAT_OTHER) { 551e689cf4aSJeff Kirsher u16 pci_cfg_stat; 552e689cf4aSJeff Kirsher 553e689cf4aSJeff Kirsher /* Interrogate PCI config space for the 554e689cf4aSJeff Kirsher * true cause. 555e689cf4aSJeff Kirsher */ 556e689cf4aSJeff Kirsher pci_read_config_word(gp->pdev, PCI_STATUS, 557e689cf4aSJeff Kirsher &pci_cfg_stat); 558e689cf4aSJeff Kirsher netdev_err(dev, "Read PCI cfg space status [%04x]\n", 559e689cf4aSJeff Kirsher pci_cfg_stat); 560e689cf4aSJeff Kirsher if (pci_cfg_stat & PCI_STATUS_PARITY) 561e689cf4aSJeff Kirsher netdev_err(dev, "PCI parity error detected\n"); 562e689cf4aSJeff Kirsher if (pci_cfg_stat & PCI_STATUS_SIG_TARGET_ABORT) 563e689cf4aSJeff Kirsher netdev_err(dev, "PCI target abort\n"); 564e689cf4aSJeff Kirsher if (pci_cfg_stat & PCI_STATUS_REC_TARGET_ABORT) 565e689cf4aSJeff Kirsher netdev_err(dev, "PCI master acks target abort\n"); 566e689cf4aSJeff Kirsher if (pci_cfg_stat & PCI_STATUS_REC_MASTER_ABORT) 567e689cf4aSJeff Kirsher netdev_err(dev, "PCI master abort\n"); 568e689cf4aSJeff Kirsher if (pci_cfg_stat & PCI_STATUS_SIG_SYSTEM_ERROR) 569e689cf4aSJeff Kirsher netdev_err(dev, "PCI system error SERR#\n"); 570e689cf4aSJeff Kirsher if (pci_cfg_stat & PCI_STATUS_DETECTED_PARITY) 571e689cf4aSJeff Kirsher netdev_err(dev, "PCI parity error\n"); 572e689cf4aSJeff Kirsher 573e689cf4aSJeff Kirsher /* Write the error bits back to clear them. */ 574e689cf4aSJeff Kirsher pci_cfg_stat &= (PCI_STATUS_PARITY | 575e689cf4aSJeff Kirsher PCI_STATUS_SIG_TARGET_ABORT | 576e689cf4aSJeff Kirsher PCI_STATUS_REC_TARGET_ABORT | 577e689cf4aSJeff Kirsher PCI_STATUS_REC_MASTER_ABORT | 578e689cf4aSJeff Kirsher PCI_STATUS_SIG_SYSTEM_ERROR | 579e689cf4aSJeff Kirsher PCI_STATUS_DETECTED_PARITY); 580e689cf4aSJeff Kirsher pci_write_config_word(gp->pdev, 581e689cf4aSJeff Kirsher PCI_STATUS, pci_cfg_stat); 582e689cf4aSJeff Kirsher } 583e689cf4aSJeff Kirsher 584e689cf4aSJeff Kirsher /* For all PCI errors, we should reset the chip. */ 585e689cf4aSJeff Kirsher return 1; 586e689cf4aSJeff Kirsher } 587e689cf4aSJeff Kirsher 588e689cf4aSJeff Kirsher /* All non-normal interrupt conditions get serviced here. 589e689cf4aSJeff Kirsher * Returns non-zero if we should just exit the interrupt 590e689cf4aSJeff Kirsher * handler right now (ie. if we reset the card which invalidates 591e689cf4aSJeff Kirsher * all of the other original irq status bits). 592e689cf4aSJeff Kirsher */ 593e689cf4aSJeff Kirsher static int gem_abnormal_irq(struct net_device *dev, struct gem *gp, u32 gem_status) 594e689cf4aSJeff Kirsher { 595e689cf4aSJeff Kirsher if (gem_status & GREG_STAT_RXNOBUF) { 596e689cf4aSJeff Kirsher /* Frame arrived, no free RX buffers available. */ 597e689cf4aSJeff Kirsher if (netif_msg_rx_err(gp)) 598e689cf4aSJeff Kirsher printk(KERN_DEBUG "%s: no buffer for rx frame\n", 599e689cf4aSJeff Kirsher gp->dev->name); 600e689cf4aSJeff Kirsher dev->stats.rx_dropped++; 601e689cf4aSJeff Kirsher } 602e689cf4aSJeff Kirsher 603e689cf4aSJeff Kirsher if (gem_status & GREG_STAT_RXTAGERR) { 604e689cf4aSJeff Kirsher /* corrupt RX tag framing */ 605e689cf4aSJeff Kirsher if (netif_msg_rx_err(gp)) 606e689cf4aSJeff Kirsher printk(KERN_DEBUG "%s: corrupt rx tag framing\n", 607e689cf4aSJeff Kirsher gp->dev->name); 608e689cf4aSJeff Kirsher dev->stats.rx_errors++; 609e689cf4aSJeff Kirsher 610e689cf4aSJeff Kirsher return 1; 611e689cf4aSJeff Kirsher } 612e689cf4aSJeff Kirsher 613e689cf4aSJeff Kirsher if (gem_status & GREG_STAT_PCS) { 614e689cf4aSJeff Kirsher if (gem_pcs_interrupt(dev, gp, gem_status)) 615e689cf4aSJeff Kirsher return 1; 616e689cf4aSJeff Kirsher } 617e689cf4aSJeff Kirsher 618e689cf4aSJeff Kirsher if (gem_status & GREG_STAT_TXMAC) { 619e689cf4aSJeff Kirsher if (gem_txmac_interrupt(dev, gp, gem_status)) 620e689cf4aSJeff Kirsher return 1; 621e689cf4aSJeff Kirsher } 622e689cf4aSJeff Kirsher 623e689cf4aSJeff Kirsher if (gem_status & GREG_STAT_RXMAC) { 624e689cf4aSJeff Kirsher if (gem_rxmac_interrupt(dev, gp, gem_status)) 625e689cf4aSJeff Kirsher return 1; 626e689cf4aSJeff Kirsher } 627e689cf4aSJeff Kirsher 628e689cf4aSJeff Kirsher if (gem_status & GREG_STAT_MAC) { 629e689cf4aSJeff Kirsher if (gem_mac_interrupt(dev, gp, gem_status)) 630e689cf4aSJeff Kirsher return 1; 631e689cf4aSJeff Kirsher } 632e689cf4aSJeff Kirsher 633e689cf4aSJeff Kirsher if (gem_status & GREG_STAT_MIF) { 634e689cf4aSJeff Kirsher if (gem_mif_interrupt(dev, gp, gem_status)) 635e689cf4aSJeff Kirsher return 1; 636e689cf4aSJeff Kirsher } 637e689cf4aSJeff Kirsher 638e689cf4aSJeff Kirsher if (gem_status & GREG_STAT_PCIERR) { 639e689cf4aSJeff Kirsher if (gem_pci_interrupt(dev, gp, gem_status)) 640e689cf4aSJeff Kirsher return 1; 641e689cf4aSJeff Kirsher } 642e689cf4aSJeff Kirsher 643e689cf4aSJeff Kirsher return 0; 644e689cf4aSJeff Kirsher } 645e689cf4aSJeff Kirsher 646e689cf4aSJeff Kirsher static __inline__ void gem_tx(struct net_device *dev, struct gem *gp, u32 gem_status) 647e689cf4aSJeff Kirsher { 648e689cf4aSJeff Kirsher int entry, limit; 649e689cf4aSJeff Kirsher 650e689cf4aSJeff Kirsher entry = gp->tx_old; 651e689cf4aSJeff Kirsher limit = ((gem_status & GREG_STAT_TXNR) >> GREG_STAT_TXNR_SHIFT); 652e689cf4aSJeff Kirsher while (entry != limit) { 653e689cf4aSJeff Kirsher struct sk_buff *skb; 654e689cf4aSJeff Kirsher struct gem_txd *txd; 655e689cf4aSJeff Kirsher dma_addr_t dma_addr; 656e689cf4aSJeff Kirsher u32 dma_len; 657e689cf4aSJeff Kirsher int frag; 658e689cf4aSJeff Kirsher 659e689cf4aSJeff Kirsher if (netif_msg_tx_done(gp)) 660e689cf4aSJeff Kirsher printk(KERN_DEBUG "%s: tx done, slot %d\n", 661e689cf4aSJeff Kirsher gp->dev->name, entry); 662e689cf4aSJeff Kirsher skb = gp->tx_skbs[entry]; 663e689cf4aSJeff Kirsher if (skb_shinfo(skb)->nr_frags) { 664e689cf4aSJeff Kirsher int last = entry + skb_shinfo(skb)->nr_frags; 665e689cf4aSJeff Kirsher int walk = entry; 666e689cf4aSJeff Kirsher int incomplete = 0; 667e689cf4aSJeff Kirsher 668e689cf4aSJeff Kirsher last &= (TX_RING_SIZE - 1); 669e689cf4aSJeff Kirsher for (;;) { 670e689cf4aSJeff Kirsher walk = NEXT_TX(walk); 671e689cf4aSJeff Kirsher if (walk == limit) 672e689cf4aSJeff Kirsher incomplete = 1; 673e689cf4aSJeff Kirsher if (walk == last) 674e689cf4aSJeff Kirsher break; 675e689cf4aSJeff Kirsher } 676e689cf4aSJeff Kirsher if (incomplete) 677e689cf4aSJeff Kirsher break; 678e689cf4aSJeff Kirsher } 679e689cf4aSJeff Kirsher gp->tx_skbs[entry] = NULL; 680e689cf4aSJeff Kirsher dev->stats.tx_bytes += skb->len; 681e689cf4aSJeff Kirsher 682e689cf4aSJeff Kirsher for (frag = 0; frag <= skb_shinfo(skb)->nr_frags; frag++) { 683e689cf4aSJeff Kirsher txd = &gp->init_block->txd[entry]; 684e689cf4aSJeff Kirsher 685e689cf4aSJeff Kirsher dma_addr = le64_to_cpu(txd->buffer); 686e689cf4aSJeff Kirsher dma_len = le64_to_cpu(txd->control_word) & TXDCTRL_BUFSZ; 687e689cf4aSJeff Kirsher 688e689cf4aSJeff Kirsher pci_unmap_page(gp->pdev, dma_addr, dma_len, PCI_DMA_TODEVICE); 689e689cf4aSJeff Kirsher entry = NEXT_TX(entry); 690e689cf4aSJeff Kirsher } 691e689cf4aSJeff Kirsher 692e689cf4aSJeff Kirsher dev->stats.tx_packets++; 693e689cf4aSJeff Kirsher dev_kfree_skb(skb); 694e689cf4aSJeff Kirsher } 695e689cf4aSJeff Kirsher gp->tx_old = entry; 696e689cf4aSJeff Kirsher 697e689cf4aSJeff Kirsher /* Need to make the tx_old update visible to gem_start_xmit() 698e689cf4aSJeff Kirsher * before checking for netif_queue_stopped(). Without the 699e689cf4aSJeff Kirsher * memory barrier, there is a small possibility that gem_start_xmit() 700e689cf4aSJeff Kirsher * will miss it and cause the queue to be stopped forever. 701e689cf4aSJeff Kirsher */ 702e689cf4aSJeff Kirsher smp_mb(); 703e689cf4aSJeff Kirsher 704e689cf4aSJeff Kirsher if (unlikely(netif_queue_stopped(dev) && 705e689cf4aSJeff Kirsher TX_BUFFS_AVAIL(gp) > (MAX_SKB_FRAGS + 1))) { 706e689cf4aSJeff Kirsher struct netdev_queue *txq = netdev_get_tx_queue(dev, 0); 707e689cf4aSJeff Kirsher 708e689cf4aSJeff Kirsher __netif_tx_lock(txq, smp_processor_id()); 709e689cf4aSJeff Kirsher if (netif_queue_stopped(dev) && 710e689cf4aSJeff Kirsher TX_BUFFS_AVAIL(gp) > (MAX_SKB_FRAGS + 1)) 711e689cf4aSJeff Kirsher netif_wake_queue(dev); 712e689cf4aSJeff Kirsher __netif_tx_unlock(txq); 713e689cf4aSJeff Kirsher } 714e689cf4aSJeff Kirsher } 715e689cf4aSJeff Kirsher 716e689cf4aSJeff Kirsher static __inline__ void gem_post_rxds(struct gem *gp, int limit) 717e689cf4aSJeff Kirsher { 718e689cf4aSJeff Kirsher int cluster_start, curr, count, kick; 719e689cf4aSJeff Kirsher 720e689cf4aSJeff Kirsher cluster_start = curr = (gp->rx_new & ~(4 - 1)); 721e689cf4aSJeff Kirsher count = 0; 722e689cf4aSJeff Kirsher kick = -1; 723e689cf4aSJeff Kirsher wmb(); 724e689cf4aSJeff Kirsher while (curr != limit) { 725e689cf4aSJeff Kirsher curr = NEXT_RX(curr); 726e689cf4aSJeff Kirsher if (++count == 4) { 727e689cf4aSJeff Kirsher struct gem_rxd *rxd = 728e689cf4aSJeff Kirsher &gp->init_block->rxd[cluster_start]; 729e689cf4aSJeff Kirsher for (;;) { 730e689cf4aSJeff Kirsher rxd->status_word = cpu_to_le64(RXDCTRL_FRESH(gp)); 731e689cf4aSJeff Kirsher rxd++; 732e689cf4aSJeff Kirsher cluster_start = NEXT_RX(cluster_start); 733e689cf4aSJeff Kirsher if (cluster_start == curr) 734e689cf4aSJeff Kirsher break; 735e689cf4aSJeff Kirsher } 736e689cf4aSJeff Kirsher kick = curr; 737e689cf4aSJeff Kirsher count = 0; 738e689cf4aSJeff Kirsher } 739e689cf4aSJeff Kirsher } 740e689cf4aSJeff Kirsher if (kick >= 0) { 741e689cf4aSJeff Kirsher mb(); 742e689cf4aSJeff Kirsher writel(kick, gp->regs + RXDMA_KICK); 743e689cf4aSJeff Kirsher } 744e689cf4aSJeff Kirsher } 745e689cf4aSJeff Kirsher 746e689cf4aSJeff Kirsher #define ALIGNED_RX_SKB_ADDR(addr) \ 747e689cf4aSJeff Kirsher ((((unsigned long)(addr) + (64UL - 1UL)) & ~(64UL - 1UL)) - (unsigned long)(addr)) 748e689cf4aSJeff Kirsher static __inline__ struct sk_buff *gem_alloc_skb(struct net_device *dev, int size, 749e689cf4aSJeff Kirsher gfp_t gfp_flags) 750e689cf4aSJeff Kirsher { 751e689cf4aSJeff Kirsher struct sk_buff *skb = alloc_skb(size + 64, gfp_flags); 752e689cf4aSJeff Kirsher 753e689cf4aSJeff Kirsher if (likely(skb)) { 754e689cf4aSJeff Kirsher unsigned long offset = ALIGNED_RX_SKB_ADDR(skb->data); 755e689cf4aSJeff Kirsher skb_reserve(skb, offset); 756e689cf4aSJeff Kirsher skb->dev = dev; 757e689cf4aSJeff Kirsher } 758e689cf4aSJeff Kirsher return skb; 759e689cf4aSJeff Kirsher } 760e689cf4aSJeff Kirsher 761e689cf4aSJeff Kirsher static int gem_rx(struct gem *gp, int work_to_do) 762e689cf4aSJeff Kirsher { 763e689cf4aSJeff Kirsher struct net_device *dev = gp->dev; 764e689cf4aSJeff Kirsher int entry, drops, work_done = 0; 765e689cf4aSJeff Kirsher u32 done; 766e689cf4aSJeff Kirsher __sum16 csum; 767e689cf4aSJeff Kirsher 768e689cf4aSJeff Kirsher if (netif_msg_rx_status(gp)) 769e689cf4aSJeff Kirsher printk(KERN_DEBUG "%s: rx interrupt, done: %d, rx_new: %d\n", 770e689cf4aSJeff Kirsher gp->dev->name, readl(gp->regs + RXDMA_DONE), gp->rx_new); 771e689cf4aSJeff Kirsher 772e689cf4aSJeff Kirsher entry = gp->rx_new; 773e689cf4aSJeff Kirsher drops = 0; 774e689cf4aSJeff Kirsher done = readl(gp->regs + RXDMA_DONE); 775e689cf4aSJeff Kirsher for (;;) { 776e689cf4aSJeff Kirsher struct gem_rxd *rxd = &gp->init_block->rxd[entry]; 777e689cf4aSJeff Kirsher struct sk_buff *skb; 778e689cf4aSJeff Kirsher u64 status = le64_to_cpu(rxd->status_word); 779e689cf4aSJeff Kirsher dma_addr_t dma_addr; 780e689cf4aSJeff Kirsher int len; 781e689cf4aSJeff Kirsher 782e689cf4aSJeff Kirsher if ((status & RXDCTRL_OWN) != 0) 783e689cf4aSJeff Kirsher break; 784e689cf4aSJeff Kirsher 785e689cf4aSJeff Kirsher if (work_done >= RX_RING_SIZE || work_done >= work_to_do) 786e689cf4aSJeff Kirsher break; 787e689cf4aSJeff Kirsher 788e689cf4aSJeff Kirsher /* When writing back RX descriptor, GEM writes status 789e689cf4aSJeff Kirsher * then buffer address, possibly in separate transactions. 790e689cf4aSJeff Kirsher * If we don't wait for the chip to write both, we could 791e689cf4aSJeff Kirsher * post a new buffer to this descriptor then have GEM spam 792e689cf4aSJeff Kirsher * on the buffer address. We sync on the RX completion 793e689cf4aSJeff Kirsher * register to prevent this from happening. 794e689cf4aSJeff Kirsher */ 795e689cf4aSJeff Kirsher if (entry == done) { 796e689cf4aSJeff Kirsher done = readl(gp->regs + RXDMA_DONE); 797e689cf4aSJeff Kirsher if (entry == done) 798e689cf4aSJeff Kirsher break; 799e689cf4aSJeff Kirsher } 800e689cf4aSJeff Kirsher 801e689cf4aSJeff Kirsher /* We can now account for the work we're about to do */ 802e689cf4aSJeff Kirsher work_done++; 803e689cf4aSJeff Kirsher 804e689cf4aSJeff Kirsher skb = gp->rx_skbs[entry]; 805e689cf4aSJeff Kirsher 806e689cf4aSJeff Kirsher len = (status & RXDCTRL_BUFSZ) >> 16; 807e689cf4aSJeff Kirsher if ((len < ETH_ZLEN) || (status & RXDCTRL_BAD)) { 808e689cf4aSJeff Kirsher dev->stats.rx_errors++; 809e689cf4aSJeff Kirsher if (len < ETH_ZLEN) 810e689cf4aSJeff Kirsher dev->stats.rx_length_errors++; 811e689cf4aSJeff Kirsher if (len & RXDCTRL_BAD) 812e689cf4aSJeff Kirsher dev->stats.rx_crc_errors++; 813e689cf4aSJeff Kirsher 814e689cf4aSJeff Kirsher /* We'll just return it to GEM. */ 815e689cf4aSJeff Kirsher drop_it: 816e689cf4aSJeff Kirsher dev->stats.rx_dropped++; 817e689cf4aSJeff Kirsher goto next; 818e689cf4aSJeff Kirsher } 819e689cf4aSJeff Kirsher 820e689cf4aSJeff Kirsher dma_addr = le64_to_cpu(rxd->buffer); 821e689cf4aSJeff Kirsher if (len > RX_COPY_THRESHOLD) { 822e689cf4aSJeff Kirsher struct sk_buff *new_skb; 823e689cf4aSJeff Kirsher 824e689cf4aSJeff Kirsher new_skb = gem_alloc_skb(dev, RX_BUF_ALLOC_SIZE(gp), GFP_ATOMIC); 825e689cf4aSJeff Kirsher if (new_skb == NULL) { 826e689cf4aSJeff Kirsher drops++; 827e689cf4aSJeff Kirsher goto drop_it; 828e689cf4aSJeff Kirsher } 829e689cf4aSJeff Kirsher pci_unmap_page(gp->pdev, dma_addr, 830e689cf4aSJeff Kirsher RX_BUF_ALLOC_SIZE(gp), 831e689cf4aSJeff Kirsher PCI_DMA_FROMDEVICE); 832e689cf4aSJeff Kirsher gp->rx_skbs[entry] = new_skb; 833e689cf4aSJeff Kirsher skb_put(new_skb, (gp->rx_buf_sz + RX_OFFSET)); 834e689cf4aSJeff Kirsher rxd->buffer = cpu_to_le64(pci_map_page(gp->pdev, 835e689cf4aSJeff Kirsher virt_to_page(new_skb->data), 836e689cf4aSJeff Kirsher offset_in_page(new_skb->data), 837e689cf4aSJeff Kirsher RX_BUF_ALLOC_SIZE(gp), 838e689cf4aSJeff Kirsher PCI_DMA_FROMDEVICE)); 839e689cf4aSJeff Kirsher skb_reserve(new_skb, RX_OFFSET); 840e689cf4aSJeff Kirsher 841e689cf4aSJeff Kirsher /* Trim the original skb for the netif. */ 842e689cf4aSJeff Kirsher skb_trim(skb, len); 843e689cf4aSJeff Kirsher } else { 844e689cf4aSJeff Kirsher struct sk_buff *copy_skb = netdev_alloc_skb(dev, len + 2); 845e689cf4aSJeff Kirsher 846e689cf4aSJeff Kirsher if (copy_skb == NULL) { 847e689cf4aSJeff Kirsher drops++; 848e689cf4aSJeff Kirsher goto drop_it; 849e689cf4aSJeff Kirsher } 850e689cf4aSJeff Kirsher 851e689cf4aSJeff Kirsher skb_reserve(copy_skb, 2); 852e689cf4aSJeff Kirsher skb_put(copy_skb, len); 853e689cf4aSJeff Kirsher pci_dma_sync_single_for_cpu(gp->pdev, dma_addr, len, PCI_DMA_FROMDEVICE); 854e689cf4aSJeff Kirsher skb_copy_from_linear_data(skb, copy_skb->data, len); 855e689cf4aSJeff Kirsher pci_dma_sync_single_for_device(gp->pdev, dma_addr, len, PCI_DMA_FROMDEVICE); 856e689cf4aSJeff Kirsher 857e689cf4aSJeff Kirsher /* We'll reuse the original ring buffer. */ 858e689cf4aSJeff Kirsher skb = copy_skb; 859e689cf4aSJeff Kirsher } 860e689cf4aSJeff Kirsher 861e689cf4aSJeff Kirsher csum = (__force __sum16)htons((status & RXDCTRL_TCPCSUM) ^ 0xffff); 862e689cf4aSJeff Kirsher skb->csum = csum_unfold(csum); 863e689cf4aSJeff Kirsher skb->ip_summed = CHECKSUM_COMPLETE; 864e689cf4aSJeff Kirsher skb->protocol = eth_type_trans(skb, gp->dev); 865e689cf4aSJeff Kirsher 866e689cf4aSJeff Kirsher napi_gro_receive(&gp->napi, skb); 867e689cf4aSJeff Kirsher 868e689cf4aSJeff Kirsher dev->stats.rx_packets++; 869e689cf4aSJeff Kirsher dev->stats.rx_bytes += len; 870e689cf4aSJeff Kirsher 871e689cf4aSJeff Kirsher next: 872e689cf4aSJeff Kirsher entry = NEXT_RX(entry); 873e689cf4aSJeff Kirsher } 874e689cf4aSJeff Kirsher 875e689cf4aSJeff Kirsher gem_post_rxds(gp, entry); 876e689cf4aSJeff Kirsher 877e689cf4aSJeff Kirsher gp->rx_new = entry; 878e689cf4aSJeff Kirsher 879e689cf4aSJeff Kirsher if (drops) 880e689cf4aSJeff Kirsher netdev_info(gp->dev, "Memory squeeze, deferring packet\n"); 881e689cf4aSJeff Kirsher 882e689cf4aSJeff Kirsher return work_done; 883e689cf4aSJeff Kirsher } 884e689cf4aSJeff Kirsher 885e689cf4aSJeff Kirsher static int gem_poll(struct napi_struct *napi, int budget) 886e689cf4aSJeff Kirsher { 887e689cf4aSJeff Kirsher struct gem *gp = container_of(napi, struct gem, napi); 888e689cf4aSJeff Kirsher struct net_device *dev = gp->dev; 889e689cf4aSJeff Kirsher int work_done; 890e689cf4aSJeff Kirsher 891e689cf4aSJeff Kirsher work_done = 0; 892e689cf4aSJeff Kirsher do { 893e689cf4aSJeff Kirsher /* Handle anomalies */ 894e689cf4aSJeff Kirsher if (unlikely(gp->status & GREG_STAT_ABNORMAL)) { 895e689cf4aSJeff Kirsher struct netdev_queue *txq = netdev_get_tx_queue(dev, 0); 896e689cf4aSJeff Kirsher int reset; 897e689cf4aSJeff Kirsher 898e689cf4aSJeff Kirsher /* We run the abnormal interrupt handling code with 899e689cf4aSJeff Kirsher * the Tx lock. It only resets the Rx portion of the 900e689cf4aSJeff Kirsher * chip, but we need to guard it against DMA being 901e689cf4aSJeff Kirsher * restarted by the link poll timer 902e689cf4aSJeff Kirsher */ 903e689cf4aSJeff Kirsher __netif_tx_lock(txq, smp_processor_id()); 904e689cf4aSJeff Kirsher reset = gem_abnormal_irq(dev, gp, gp->status); 905e689cf4aSJeff Kirsher __netif_tx_unlock(txq); 906e689cf4aSJeff Kirsher if (reset) { 907e689cf4aSJeff Kirsher gem_schedule_reset(gp); 908e689cf4aSJeff Kirsher napi_complete(napi); 909e689cf4aSJeff Kirsher return work_done; 910e689cf4aSJeff Kirsher } 911e689cf4aSJeff Kirsher } 912e689cf4aSJeff Kirsher 913e689cf4aSJeff Kirsher /* Run TX completion thread */ 914e689cf4aSJeff Kirsher gem_tx(dev, gp, gp->status); 915e689cf4aSJeff Kirsher 916e689cf4aSJeff Kirsher /* Run RX thread. We don't use any locking here, 917e689cf4aSJeff Kirsher * code willing to do bad things - like cleaning the 918e689cf4aSJeff Kirsher * rx ring - must call napi_disable(), which 919e689cf4aSJeff Kirsher * schedule_timeout()'s if polling is already disabled. 920e689cf4aSJeff Kirsher */ 921e689cf4aSJeff Kirsher work_done += gem_rx(gp, budget - work_done); 922e689cf4aSJeff Kirsher 923e689cf4aSJeff Kirsher if (work_done >= budget) 924e689cf4aSJeff Kirsher return work_done; 925e689cf4aSJeff Kirsher 926e689cf4aSJeff Kirsher gp->status = readl(gp->regs + GREG_STAT); 927e689cf4aSJeff Kirsher } while (gp->status & GREG_STAT_NAPI); 928e689cf4aSJeff Kirsher 929e689cf4aSJeff Kirsher napi_complete(napi); 930e689cf4aSJeff Kirsher gem_enable_ints(gp); 931e689cf4aSJeff Kirsher 932e689cf4aSJeff Kirsher return work_done; 933e689cf4aSJeff Kirsher } 934e689cf4aSJeff Kirsher 935e689cf4aSJeff Kirsher static irqreturn_t gem_interrupt(int irq, void *dev_id) 936e689cf4aSJeff Kirsher { 937e689cf4aSJeff Kirsher struct net_device *dev = dev_id; 938e689cf4aSJeff Kirsher struct gem *gp = netdev_priv(dev); 939e689cf4aSJeff Kirsher 940e689cf4aSJeff Kirsher if (napi_schedule_prep(&gp->napi)) { 941e689cf4aSJeff Kirsher u32 gem_status = readl(gp->regs + GREG_STAT); 942e689cf4aSJeff Kirsher 943e689cf4aSJeff Kirsher if (unlikely(gem_status == 0)) { 944e689cf4aSJeff Kirsher napi_enable(&gp->napi); 945e689cf4aSJeff Kirsher return IRQ_NONE; 946e689cf4aSJeff Kirsher } 947e689cf4aSJeff Kirsher if (netif_msg_intr(gp)) 948e689cf4aSJeff Kirsher printk(KERN_DEBUG "%s: gem_interrupt() gem_status: 0x%x\n", 949e689cf4aSJeff Kirsher gp->dev->name, gem_status); 950e689cf4aSJeff Kirsher 951e689cf4aSJeff Kirsher gp->status = gem_status; 952e689cf4aSJeff Kirsher gem_disable_ints(gp); 953e689cf4aSJeff Kirsher __napi_schedule(&gp->napi); 954e689cf4aSJeff Kirsher } 955e689cf4aSJeff Kirsher 956e689cf4aSJeff Kirsher /* If polling was disabled at the time we received that 957e689cf4aSJeff Kirsher * interrupt, we may return IRQ_HANDLED here while we 958e689cf4aSJeff Kirsher * should return IRQ_NONE. No big deal... 959e689cf4aSJeff Kirsher */ 960e689cf4aSJeff Kirsher return IRQ_HANDLED; 961e689cf4aSJeff Kirsher } 962e689cf4aSJeff Kirsher 963e689cf4aSJeff Kirsher #ifdef CONFIG_NET_POLL_CONTROLLER 964e689cf4aSJeff Kirsher static void gem_poll_controller(struct net_device *dev) 965e689cf4aSJeff Kirsher { 966e689cf4aSJeff Kirsher struct gem *gp = netdev_priv(dev); 967e689cf4aSJeff Kirsher 968e689cf4aSJeff Kirsher disable_irq(gp->pdev->irq); 969e689cf4aSJeff Kirsher gem_interrupt(gp->pdev->irq, dev); 970e689cf4aSJeff Kirsher enable_irq(gp->pdev->irq); 971e689cf4aSJeff Kirsher } 972e689cf4aSJeff Kirsher #endif 973e689cf4aSJeff Kirsher 974e689cf4aSJeff Kirsher static void gem_tx_timeout(struct net_device *dev) 975e689cf4aSJeff Kirsher { 976e689cf4aSJeff Kirsher struct gem *gp = netdev_priv(dev); 977e689cf4aSJeff Kirsher 978e689cf4aSJeff Kirsher netdev_err(dev, "transmit timed out, resetting\n"); 979e689cf4aSJeff Kirsher 980e689cf4aSJeff Kirsher netdev_err(dev, "TX_STATE[%08x:%08x:%08x]\n", 981e689cf4aSJeff Kirsher readl(gp->regs + TXDMA_CFG), 982e689cf4aSJeff Kirsher readl(gp->regs + MAC_TXSTAT), 983e689cf4aSJeff Kirsher readl(gp->regs + MAC_TXCFG)); 984e689cf4aSJeff Kirsher netdev_err(dev, "RX_STATE[%08x:%08x:%08x]\n", 985e689cf4aSJeff Kirsher readl(gp->regs + RXDMA_CFG), 986e689cf4aSJeff Kirsher readl(gp->regs + MAC_RXSTAT), 987e689cf4aSJeff Kirsher readl(gp->regs + MAC_RXCFG)); 988e689cf4aSJeff Kirsher 989e689cf4aSJeff Kirsher gem_schedule_reset(gp); 990e689cf4aSJeff Kirsher } 991e689cf4aSJeff Kirsher 992e689cf4aSJeff Kirsher static __inline__ int gem_intme(int entry) 993e689cf4aSJeff Kirsher { 994e689cf4aSJeff Kirsher /* Algorithm: IRQ every 1/2 of descriptors. */ 995e689cf4aSJeff Kirsher if (!(entry & ((TX_RING_SIZE>>1)-1))) 996e689cf4aSJeff Kirsher return 1; 997e689cf4aSJeff Kirsher 998e689cf4aSJeff Kirsher return 0; 999e689cf4aSJeff Kirsher } 1000e689cf4aSJeff Kirsher 1001e689cf4aSJeff Kirsher static netdev_tx_t gem_start_xmit(struct sk_buff *skb, 1002e689cf4aSJeff Kirsher struct net_device *dev) 1003e689cf4aSJeff Kirsher { 1004e689cf4aSJeff Kirsher struct gem *gp = netdev_priv(dev); 1005e689cf4aSJeff Kirsher int entry; 1006e689cf4aSJeff Kirsher u64 ctrl; 1007e689cf4aSJeff Kirsher 1008e689cf4aSJeff Kirsher ctrl = 0; 1009e689cf4aSJeff Kirsher if (skb->ip_summed == CHECKSUM_PARTIAL) { 1010e689cf4aSJeff Kirsher const u64 csum_start_off = skb_checksum_start_offset(skb); 1011e689cf4aSJeff Kirsher const u64 csum_stuff_off = csum_start_off + skb->csum_offset; 1012e689cf4aSJeff Kirsher 1013e689cf4aSJeff Kirsher ctrl = (TXDCTRL_CENAB | 1014e689cf4aSJeff Kirsher (csum_start_off << 15) | 1015e689cf4aSJeff Kirsher (csum_stuff_off << 21)); 1016e689cf4aSJeff Kirsher } 1017e689cf4aSJeff Kirsher 1018e689cf4aSJeff Kirsher if (unlikely(TX_BUFFS_AVAIL(gp) <= (skb_shinfo(skb)->nr_frags + 1))) { 1019e689cf4aSJeff Kirsher /* This is a hard error, log it. */ 1020e689cf4aSJeff Kirsher if (!netif_queue_stopped(dev)) { 1021e689cf4aSJeff Kirsher netif_stop_queue(dev); 1022e689cf4aSJeff Kirsher netdev_err(dev, "BUG! Tx Ring full when queue awake!\n"); 1023e689cf4aSJeff Kirsher } 1024e689cf4aSJeff Kirsher return NETDEV_TX_BUSY; 1025e689cf4aSJeff Kirsher } 1026e689cf4aSJeff Kirsher 1027e689cf4aSJeff Kirsher entry = gp->tx_new; 1028e689cf4aSJeff Kirsher gp->tx_skbs[entry] = skb; 1029e689cf4aSJeff Kirsher 1030e689cf4aSJeff Kirsher if (skb_shinfo(skb)->nr_frags == 0) { 1031e689cf4aSJeff Kirsher struct gem_txd *txd = &gp->init_block->txd[entry]; 1032e689cf4aSJeff Kirsher dma_addr_t mapping; 1033e689cf4aSJeff Kirsher u32 len; 1034e689cf4aSJeff Kirsher 1035e689cf4aSJeff Kirsher len = skb->len; 1036e689cf4aSJeff Kirsher mapping = pci_map_page(gp->pdev, 1037e689cf4aSJeff Kirsher virt_to_page(skb->data), 1038e689cf4aSJeff Kirsher offset_in_page(skb->data), 1039e689cf4aSJeff Kirsher len, PCI_DMA_TODEVICE); 1040e689cf4aSJeff Kirsher ctrl |= TXDCTRL_SOF | TXDCTRL_EOF | len; 1041e689cf4aSJeff Kirsher if (gem_intme(entry)) 1042e689cf4aSJeff Kirsher ctrl |= TXDCTRL_INTME; 1043e689cf4aSJeff Kirsher txd->buffer = cpu_to_le64(mapping); 1044e689cf4aSJeff Kirsher wmb(); 1045e689cf4aSJeff Kirsher txd->control_word = cpu_to_le64(ctrl); 1046e689cf4aSJeff Kirsher entry = NEXT_TX(entry); 1047e689cf4aSJeff Kirsher } else { 1048e689cf4aSJeff Kirsher struct gem_txd *txd; 1049e689cf4aSJeff Kirsher u32 first_len; 1050e689cf4aSJeff Kirsher u64 intme; 1051e689cf4aSJeff Kirsher dma_addr_t first_mapping; 1052e689cf4aSJeff Kirsher int frag, first_entry = entry; 1053e689cf4aSJeff Kirsher 1054e689cf4aSJeff Kirsher intme = 0; 1055e689cf4aSJeff Kirsher if (gem_intme(entry)) 1056e689cf4aSJeff Kirsher intme |= TXDCTRL_INTME; 1057e689cf4aSJeff Kirsher 1058e689cf4aSJeff Kirsher /* We must give this initial chunk to the device last. 1059e689cf4aSJeff Kirsher * Otherwise we could race with the device. 1060e689cf4aSJeff Kirsher */ 1061e689cf4aSJeff Kirsher first_len = skb_headlen(skb); 1062e689cf4aSJeff Kirsher first_mapping = pci_map_page(gp->pdev, virt_to_page(skb->data), 1063e689cf4aSJeff Kirsher offset_in_page(skb->data), 1064e689cf4aSJeff Kirsher first_len, PCI_DMA_TODEVICE); 1065e689cf4aSJeff Kirsher entry = NEXT_TX(entry); 1066e689cf4aSJeff Kirsher 1067e689cf4aSJeff Kirsher for (frag = 0; frag < skb_shinfo(skb)->nr_frags; frag++) { 1068e689cf4aSJeff Kirsher skb_frag_t *this_frag = &skb_shinfo(skb)->frags[frag]; 1069e689cf4aSJeff Kirsher u32 len; 1070e689cf4aSJeff Kirsher dma_addr_t mapping; 1071e689cf4aSJeff Kirsher u64 this_ctrl; 1072e689cf4aSJeff Kirsher 1073e689cf4aSJeff Kirsher len = this_frag->size; 10744fee78b4SIan Campbell mapping = skb_frag_dma_map(&gp->pdev->dev, this_frag, 10755d6bcdfeSIan Campbell 0, len, DMA_TO_DEVICE); 1076e689cf4aSJeff Kirsher this_ctrl = ctrl; 1077e689cf4aSJeff Kirsher if (frag == skb_shinfo(skb)->nr_frags - 1) 1078e689cf4aSJeff Kirsher this_ctrl |= TXDCTRL_EOF; 1079e689cf4aSJeff Kirsher 1080e689cf4aSJeff Kirsher txd = &gp->init_block->txd[entry]; 1081e689cf4aSJeff Kirsher txd->buffer = cpu_to_le64(mapping); 1082e689cf4aSJeff Kirsher wmb(); 1083e689cf4aSJeff Kirsher txd->control_word = cpu_to_le64(this_ctrl | len); 1084e689cf4aSJeff Kirsher 1085e689cf4aSJeff Kirsher if (gem_intme(entry)) 1086e689cf4aSJeff Kirsher intme |= TXDCTRL_INTME; 1087e689cf4aSJeff Kirsher 1088e689cf4aSJeff Kirsher entry = NEXT_TX(entry); 1089e689cf4aSJeff Kirsher } 1090e689cf4aSJeff Kirsher txd = &gp->init_block->txd[first_entry]; 1091e689cf4aSJeff Kirsher txd->buffer = cpu_to_le64(first_mapping); 1092e689cf4aSJeff Kirsher wmb(); 1093e689cf4aSJeff Kirsher txd->control_word = 1094e689cf4aSJeff Kirsher cpu_to_le64(ctrl | TXDCTRL_SOF | intme | first_len); 1095e689cf4aSJeff Kirsher } 1096e689cf4aSJeff Kirsher 1097e689cf4aSJeff Kirsher gp->tx_new = entry; 1098e689cf4aSJeff Kirsher if (unlikely(TX_BUFFS_AVAIL(gp) <= (MAX_SKB_FRAGS + 1))) { 1099e689cf4aSJeff Kirsher netif_stop_queue(dev); 1100e689cf4aSJeff Kirsher 1101e689cf4aSJeff Kirsher /* netif_stop_queue() must be done before checking 1102e689cf4aSJeff Kirsher * checking tx index in TX_BUFFS_AVAIL() below, because 1103e689cf4aSJeff Kirsher * in gem_tx(), we update tx_old before checking for 1104e689cf4aSJeff Kirsher * netif_queue_stopped(). 1105e689cf4aSJeff Kirsher */ 1106e689cf4aSJeff Kirsher smp_mb(); 1107e689cf4aSJeff Kirsher if (TX_BUFFS_AVAIL(gp) > (MAX_SKB_FRAGS + 1)) 1108e689cf4aSJeff Kirsher netif_wake_queue(dev); 1109e689cf4aSJeff Kirsher } 1110e689cf4aSJeff Kirsher if (netif_msg_tx_queued(gp)) 1111e689cf4aSJeff Kirsher printk(KERN_DEBUG "%s: tx queued, slot %d, skblen %d\n", 1112e689cf4aSJeff Kirsher dev->name, entry, skb->len); 1113e689cf4aSJeff Kirsher mb(); 1114e689cf4aSJeff Kirsher writel(gp->tx_new, gp->regs + TXDMA_KICK); 1115e689cf4aSJeff Kirsher 1116e689cf4aSJeff Kirsher return NETDEV_TX_OK; 1117e689cf4aSJeff Kirsher } 1118e689cf4aSJeff Kirsher 1119e689cf4aSJeff Kirsher static void gem_pcs_reset(struct gem *gp) 1120e689cf4aSJeff Kirsher { 1121e689cf4aSJeff Kirsher int limit; 1122e689cf4aSJeff Kirsher u32 val; 1123e689cf4aSJeff Kirsher 1124e689cf4aSJeff Kirsher /* Reset PCS unit. */ 1125e689cf4aSJeff Kirsher val = readl(gp->regs + PCS_MIICTRL); 1126e689cf4aSJeff Kirsher val |= PCS_MIICTRL_RST; 1127e689cf4aSJeff Kirsher writel(val, gp->regs + PCS_MIICTRL); 1128e689cf4aSJeff Kirsher 1129e689cf4aSJeff Kirsher limit = 32; 1130e689cf4aSJeff Kirsher while (readl(gp->regs + PCS_MIICTRL) & PCS_MIICTRL_RST) { 1131e689cf4aSJeff Kirsher udelay(100); 1132e689cf4aSJeff Kirsher if (limit-- <= 0) 1133e689cf4aSJeff Kirsher break; 1134e689cf4aSJeff Kirsher } 1135e689cf4aSJeff Kirsher if (limit < 0) 1136e689cf4aSJeff Kirsher netdev_warn(gp->dev, "PCS reset bit would not clear\n"); 1137e689cf4aSJeff Kirsher } 1138e689cf4aSJeff Kirsher 1139e689cf4aSJeff Kirsher static void gem_pcs_reinit_adv(struct gem *gp) 1140e689cf4aSJeff Kirsher { 1141e689cf4aSJeff Kirsher u32 val; 1142e689cf4aSJeff Kirsher 1143e689cf4aSJeff Kirsher /* Make sure PCS is disabled while changing advertisement 1144e689cf4aSJeff Kirsher * configuration. 1145e689cf4aSJeff Kirsher */ 1146e689cf4aSJeff Kirsher val = readl(gp->regs + PCS_CFG); 1147e689cf4aSJeff Kirsher val &= ~(PCS_CFG_ENABLE | PCS_CFG_TO); 1148e689cf4aSJeff Kirsher writel(val, gp->regs + PCS_CFG); 1149e689cf4aSJeff Kirsher 1150e689cf4aSJeff Kirsher /* Advertise all capabilities except asymmetric 1151e689cf4aSJeff Kirsher * pause. 1152e689cf4aSJeff Kirsher */ 1153e689cf4aSJeff Kirsher val = readl(gp->regs + PCS_MIIADV); 1154e689cf4aSJeff Kirsher val |= (PCS_MIIADV_FD | PCS_MIIADV_HD | 1155e689cf4aSJeff Kirsher PCS_MIIADV_SP | PCS_MIIADV_AP); 1156e689cf4aSJeff Kirsher writel(val, gp->regs + PCS_MIIADV); 1157e689cf4aSJeff Kirsher 1158e689cf4aSJeff Kirsher /* Enable and restart auto-negotiation, disable wrapback/loopback, 1159e689cf4aSJeff Kirsher * and re-enable PCS. 1160e689cf4aSJeff Kirsher */ 1161e689cf4aSJeff Kirsher val = readl(gp->regs + PCS_MIICTRL); 1162e689cf4aSJeff Kirsher val |= (PCS_MIICTRL_RAN | PCS_MIICTRL_ANE); 1163e689cf4aSJeff Kirsher val &= ~PCS_MIICTRL_WB; 1164e689cf4aSJeff Kirsher writel(val, gp->regs + PCS_MIICTRL); 1165e689cf4aSJeff Kirsher 1166e689cf4aSJeff Kirsher val = readl(gp->regs + PCS_CFG); 1167e689cf4aSJeff Kirsher val |= PCS_CFG_ENABLE; 1168e689cf4aSJeff Kirsher writel(val, gp->regs + PCS_CFG); 1169e689cf4aSJeff Kirsher 1170e689cf4aSJeff Kirsher /* Make sure serialink loopback is off. The meaning 1171e689cf4aSJeff Kirsher * of this bit is logically inverted based upon whether 1172e689cf4aSJeff Kirsher * you are in Serialink or SERDES mode. 1173e689cf4aSJeff Kirsher */ 1174e689cf4aSJeff Kirsher val = readl(gp->regs + PCS_SCTRL); 1175e689cf4aSJeff Kirsher if (gp->phy_type == phy_serialink) 1176e689cf4aSJeff Kirsher val &= ~PCS_SCTRL_LOOP; 1177e689cf4aSJeff Kirsher else 1178e689cf4aSJeff Kirsher val |= PCS_SCTRL_LOOP; 1179e689cf4aSJeff Kirsher writel(val, gp->regs + PCS_SCTRL); 1180e689cf4aSJeff Kirsher } 1181e689cf4aSJeff Kirsher 1182e689cf4aSJeff Kirsher #define STOP_TRIES 32 1183e689cf4aSJeff Kirsher 1184e689cf4aSJeff Kirsher static void gem_reset(struct gem *gp) 1185e689cf4aSJeff Kirsher { 1186e689cf4aSJeff Kirsher int limit; 1187e689cf4aSJeff Kirsher u32 val; 1188e689cf4aSJeff Kirsher 1189e689cf4aSJeff Kirsher /* Make sure we won't get any more interrupts */ 1190e689cf4aSJeff Kirsher writel(0xffffffff, gp->regs + GREG_IMASK); 1191e689cf4aSJeff Kirsher 1192e689cf4aSJeff Kirsher /* Reset the chip */ 1193e689cf4aSJeff Kirsher writel(gp->swrst_base | GREG_SWRST_TXRST | GREG_SWRST_RXRST, 1194e689cf4aSJeff Kirsher gp->regs + GREG_SWRST); 1195e689cf4aSJeff Kirsher 1196e689cf4aSJeff Kirsher limit = STOP_TRIES; 1197e689cf4aSJeff Kirsher 1198e689cf4aSJeff Kirsher do { 1199e689cf4aSJeff Kirsher udelay(20); 1200e689cf4aSJeff Kirsher val = readl(gp->regs + GREG_SWRST); 1201e689cf4aSJeff Kirsher if (limit-- <= 0) 1202e689cf4aSJeff Kirsher break; 1203e689cf4aSJeff Kirsher } while (val & (GREG_SWRST_TXRST | GREG_SWRST_RXRST)); 1204e689cf4aSJeff Kirsher 1205e689cf4aSJeff Kirsher if (limit < 0) 1206e689cf4aSJeff Kirsher netdev_err(gp->dev, "SW reset is ghetto\n"); 1207e689cf4aSJeff Kirsher 1208e689cf4aSJeff Kirsher if (gp->phy_type == phy_serialink || gp->phy_type == phy_serdes) 1209e689cf4aSJeff Kirsher gem_pcs_reinit_adv(gp); 1210e689cf4aSJeff Kirsher } 1211e689cf4aSJeff Kirsher 1212e689cf4aSJeff Kirsher static void gem_start_dma(struct gem *gp) 1213e689cf4aSJeff Kirsher { 1214e689cf4aSJeff Kirsher u32 val; 1215e689cf4aSJeff Kirsher 1216e689cf4aSJeff Kirsher /* We are ready to rock, turn everything on. */ 1217e689cf4aSJeff Kirsher val = readl(gp->regs + TXDMA_CFG); 1218e689cf4aSJeff Kirsher writel(val | TXDMA_CFG_ENABLE, gp->regs + TXDMA_CFG); 1219e689cf4aSJeff Kirsher val = readl(gp->regs + RXDMA_CFG); 1220e689cf4aSJeff Kirsher writel(val | RXDMA_CFG_ENABLE, gp->regs + RXDMA_CFG); 1221e689cf4aSJeff Kirsher val = readl(gp->regs + MAC_TXCFG); 1222e689cf4aSJeff Kirsher writel(val | MAC_TXCFG_ENAB, gp->regs + MAC_TXCFG); 1223e689cf4aSJeff Kirsher val = readl(gp->regs + MAC_RXCFG); 1224e689cf4aSJeff Kirsher writel(val | MAC_RXCFG_ENAB, gp->regs + MAC_RXCFG); 1225e689cf4aSJeff Kirsher 1226e689cf4aSJeff Kirsher (void) readl(gp->regs + MAC_RXCFG); 1227e689cf4aSJeff Kirsher udelay(100); 1228e689cf4aSJeff Kirsher 1229e689cf4aSJeff Kirsher gem_enable_ints(gp); 1230e689cf4aSJeff Kirsher 1231e689cf4aSJeff Kirsher writel(RX_RING_SIZE - 4, gp->regs + RXDMA_KICK); 1232e689cf4aSJeff Kirsher } 1233e689cf4aSJeff Kirsher 1234e689cf4aSJeff Kirsher /* DMA won't be actually stopped before about 4ms tho ... 1235e689cf4aSJeff Kirsher */ 1236e689cf4aSJeff Kirsher static void gem_stop_dma(struct gem *gp) 1237e689cf4aSJeff Kirsher { 1238e689cf4aSJeff Kirsher u32 val; 1239e689cf4aSJeff Kirsher 1240e689cf4aSJeff Kirsher /* We are done rocking, turn everything off. */ 1241e689cf4aSJeff Kirsher val = readl(gp->regs + TXDMA_CFG); 1242e689cf4aSJeff Kirsher writel(val & ~TXDMA_CFG_ENABLE, gp->regs + TXDMA_CFG); 1243e689cf4aSJeff Kirsher val = readl(gp->regs + RXDMA_CFG); 1244e689cf4aSJeff Kirsher writel(val & ~RXDMA_CFG_ENABLE, gp->regs + RXDMA_CFG); 1245e689cf4aSJeff Kirsher val = readl(gp->regs + MAC_TXCFG); 1246e689cf4aSJeff Kirsher writel(val & ~MAC_TXCFG_ENAB, gp->regs + MAC_TXCFG); 1247e689cf4aSJeff Kirsher val = readl(gp->regs + MAC_RXCFG); 1248e689cf4aSJeff Kirsher writel(val & ~MAC_RXCFG_ENAB, gp->regs + MAC_RXCFG); 1249e689cf4aSJeff Kirsher 1250e689cf4aSJeff Kirsher (void) readl(gp->regs + MAC_RXCFG); 1251e689cf4aSJeff Kirsher 1252e689cf4aSJeff Kirsher /* Need to wait a bit ... done by the caller */ 1253e689cf4aSJeff Kirsher } 1254e689cf4aSJeff Kirsher 1255e689cf4aSJeff Kirsher 1256e689cf4aSJeff Kirsher // XXX dbl check what that function should do when called on PCS PHY 1257e689cf4aSJeff Kirsher static void gem_begin_auto_negotiation(struct gem *gp, struct ethtool_cmd *ep) 1258e689cf4aSJeff Kirsher { 1259e689cf4aSJeff Kirsher u32 advertise, features; 1260e689cf4aSJeff Kirsher int autoneg; 1261e689cf4aSJeff Kirsher int speed; 1262e689cf4aSJeff Kirsher int duplex; 1263e689cf4aSJeff Kirsher 1264e689cf4aSJeff Kirsher if (gp->phy_type != phy_mii_mdio0 && 1265e689cf4aSJeff Kirsher gp->phy_type != phy_mii_mdio1) 1266e689cf4aSJeff Kirsher goto non_mii; 1267e689cf4aSJeff Kirsher 1268e689cf4aSJeff Kirsher /* Setup advertise */ 1269e689cf4aSJeff Kirsher if (found_mii_phy(gp)) 1270e689cf4aSJeff Kirsher features = gp->phy_mii.def->features; 1271e689cf4aSJeff Kirsher else 1272e689cf4aSJeff Kirsher features = 0; 1273e689cf4aSJeff Kirsher 1274e689cf4aSJeff Kirsher advertise = features & ADVERTISE_MASK; 1275e689cf4aSJeff Kirsher if (gp->phy_mii.advertising != 0) 1276e689cf4aSJeff Kirsher advertise &= gp->phy_mii.advertising; 1277e689cf4aSJeff Kirsher 1278e689cf4aSJeff Kirsher autoneg = gp->want_autoneg; 1279e689cf4aSJeff Kirsher speed = gp->phy_mii.speed; 1280e689cf4aSJeff Kirsher duplex = gp->phy_mii.duplex; 1281e689cf4aSJeff Kirsher 1282e689cf4aSJeff Kirsher /* Setup link parameters */ 1283e689cf4aSJeff Kirsher if (!ep) 1284e689cf4aSJeff Kirsher goto start_aneg; 1285e689cf4aSJeff Kirsher if (ep->autoneg == AUTONEG_ENABLE) { 1286e689cf4aSJeff Kirsher advertise = ep->advertising; 1287e689cf4aSJeff Kirsher autoneg = 1; 1288e689cf4aSJeff Kirsher } else { 1289e689cf4aSJeff Kirsher autoneg = 0; 1290e689cf4aSJeff Kirsher speed = ethtool_cmd_speed(ep); 1291e689cf4aSJeff Kirsher duplex = ep->duplex; 1292e689cf4aSJeff Kirsher } 1293e689cf4aSJeff Kirsher 1294e689cf4aSJeff Kirsher start_aneg: 1295e689cf4aSJeff Kirsher /* Sanitize settings based on PHY capabilities */ 1296e689cf4aSJeff Kirsher if ((features & SUPPORTED_Autoneg) == 0) 1297e689cf4aSJeff Kirsher autoneg = 0; 1298e689cf4aSJeff Kirsher if (speed == SPEED_1000 && 1299e689cf4aSJeff Kirsher !(features & (SUPPORTED_1000baseT_Half | SUPPORTED_1000baseT_Full))) 1300e689cf4aSJeff Kirsher speed = SPEED_100; 1301e689cf4aSJeff Kirsher if (speed == SPEED_100 && 1302e689cf4aSJeff Kirsher !(features & (SUPPORTED_100baseT_Half | SUPPORTED_100baseT_Full))) 1303e689cf4aSJeff Kirsher speed = SPEED_10; 1304e689cf4aSJeff Kirsher if (duplex == DUPLEX_FULL && 1305e689cf4aSJeff Kirsher !(features & (SUPPORTED_1000baseT_Full | 1306e689cf4aSJeff Kirsher SUPPORTED_100baseT_Full | 1307e689cf4aSJeff Kirsher SUPPORTED_10baseT_Full))) 1308e689cf4aSJeff Kirsher duplex = DUPLEX_HALF; 1309e689cf4aSJeff Kirsher if (speed == 0) 1310e689cf4aSJeff Kirsher speed = SPEED_10; 1311e689cf4aSJeff Kirsher 1312e689cf4aSJeff Kirsher /* If we are asleep, we don't try to actually setup the PHY, we 1313e689cf4aSJeff Kirsher * just store the settings 1314e689cf4aSJeff Kirsher */ 1315e689cf4aSJeff Kirsher if (!netif_device_present(gp->dev)) { 1316e689cf4aSJeff Kirsher gp->phy_mii.autoneg = gp->want_autoneg = autoneg; 1317e689cf4aSJeff Kirsher gp->phy_mii.speed = speed; 1318e689cf4aSJeff Kirsher gp->phy_mii.duplex = duplex; 1319e689cf4aSJeff Kirsher return; 1320e689cf4aSJeff Kirsher } 1321e689cf4aSJeff Kirsher 1322e689cf4aSJeff Kirsher /* Configure PHY & start aneg */ 1323e689cf4aSJeff Kirsher gp->want_autoneg = autoneg; 1324e689cf4aSJeff Kirsher if (autoneg) { 1325e689cf4aSJeff Kirsher if (found_mii_phy(gp)) 1326e689cf4aSJeff Kirsher gp->phy_mii.def->ops->setup_aneg(&gp->phy_mii, advertise); 1327e689cf4aSJeff Kirsher gp->lstate = link_aneg; 1328e689cf4aSJeff Kirsher } else { 1329e689cf4aSJeff Kirsher if (found_mii_phy(gp)) 1330e689cf4aSJeff Kirsher gp->phy_mii.def->ops->setup_forced(&gp->phy_mii, speed, duplex); 1331e689cf4aSJeff Kirsher gp->lstate = link_force_ok; 1332e689cf4aSJeff Kirsher } 1333e689cf4aSJeff Kirsher 1334e689cf4aSJeff Kirsher non_mii: 1335e689cf4aSJeff Kirsher gp->timer_ticks = 0; 1336e689cf4aSJeff Kirsher mod_timer(&gp->link_timer, jiffies + ((12 * HZ) / 10)); 1337e689cf4aSJeff Kirsher } 1338e689cf4aSJeff Kirsher 1339e689cf4aSJeff Kirsher /* A link-up condition has occurred, initialize and enable the 1340e689cf4aSJeff Kirsher * rest of the chip. 1341e689cf4aSJeff Kirsher */ 1342e689cf4aSJeff Kirsher static int gem_set_link_modes(struct gem *gp) 1343e689cf4aSJeff Kirsher { 1344e689cf4aSJeff Kirsher struct netdev_queue *txq = netdev_get_tx_queue(gp->dev, 0); 1345e689cf4aSJeff Kirsher int full_duplex, speed, pause; 1346e689cf4aSJeff Kirsher u32 val; 1347e689cf4aSJeff Kirsher 1348e689cf4aSJeff Kirsher full_duplex = 0; 1349e689cf4aSJeff Kirsher speed = SPEED_10; 1350e689cf4aSJeff Kirsher pause = 0; 1351e689cf4aSJeff Kirsher 1352e689cf4aSJeff Kirsher if (found_mii_phy(gp)) { 1353e689cf4aSJeff Kirsher if (gp->phy_mii.def->ops->read_link(&gp->phy_mii)) 1354e689cf4aSJeff Kirsher return 1; 1355e689cf4aSJeff Kirsher full_duplex = (gp->phy_mii.duplex == DUPLEX_FULL); 1356e689cf4aSJeff Kirsher speed = gp->phy_mii.speed; 1357e689cf4aSJeff Kirsher pause = gp->phy_mii.pause; 1358e689cf4aSJeff Kirsher } else if (gp->phy_type == phy_serialink || 1359e689cf4aSJeff Kirsher gp->phy_type == phy_serdes) { 1360e689cf4aSJeff Kirsher u32 pcs_lpa = readl(gp->regs + PCS_MIILP); 1361e689cf4aSJeff Kirsher 1362e689cf4aSJeff Kirsher if ((pcs_lpa & PCS_MIIADV_FD) || gp->phy_type == phy_serdes) 1363e689cf4aSJeff Kirsher full_duplex = 1; 1364e689cf4aSJeff Kirsher speed = SPEED_1000; 1365e689cf4aSJeff Kirsher } 1366e689cf4aSJeff Kirsher 1367e689cf4aSJeff Kirsher netif_info(gp, link, gp->dev, "Link is up at %d Mbps, %s-duplex\n", 1368e689cf4aSJeff Kirsher speed, (full_duplex ? "full" : "half")); 1369e689cf4aSJeff Kirsher 1370e689cf4aSJeff Kirsher 1371e689cf4aSJeff Kirsher /* We take the tx queue lock to avoid collisions between 1372e689cf4aSJeff Kirsher * this code, the tx path and the NAPI-driven error path 1373e689cf4aSJeff Kirsher */ 1374e689cf4aSJeff Kirsher __netif_tx_lock(txq, smp_processor_id()); 1375e689cf4aSJeff Kirsher 1376e689cf4aSJeff Kirsher val = (MAC_TXCFG_EIPG0 | MAC_TXCFG_NGU); 1377e689cf4aSJeff Kirsher if (full_duplex) { 1378e689cf4aSJeff Kirsher val |= (MAC_TXCFG_ICS | MAC_TXCFG_ICOLL); 1379e689cf4aSJeff Kirsher } else { 1380e689cf4aSJeff Kirsher /* MAC_TXCFG_NBO must be zero. */ 1381e689cf4aSJeff Kirsher } 1382e689cf4aSJeff Kirsher writel(val, gp->regs + MAC_TXCFG); 1383e689cf4aSJeff Kirsher 1384e689cf4aSJeff Kirsher val = (MAC_XIFCFG_OE | MAC_XIFCFG_LLED); 1385e689cf4aSJeff Kirsher if (!full_duplex && 1386e689cf4aSJeff Kirsher (gp->phy_type == phy_mii_mdio0 || 1387e689cf4aSJeff Kirsher gp->phy_type == phy_mii_mdio1)) { 1388e689cf4aSJeff Kirsher val |= MAC_XIFCFG_DISE; 1389e689cf4aSJeff Kirsher } else if (full_duplex) { 1390e689cf4aSJeff Kirsher val |= MAC_XIFCFG_FLED; 1391e689cf4aSJeff Kirsher } 1392e689cf4aSJeff Kirsher 1393e689cf4aSJeff Kirsher if (speed == SPEED_1000) 1394e689cf4aSJeff Kirsher val |= (MAC_XIFCFG_GMII); 1395e689cf4aSJeff Kirsher 1396e689cf4aSJeff Kirsher writel(val, gp->regs + MAC_XIFCFG); 1397e689cf4aSJeff Kirsher 1398e689cf4aSJeff Kirsher /* If gigabit and half-duplex, enable carrier extension 1399e689cf4aSJeff Kirsher * mode. Else, disable it. 1400e689cf4aSJeff Kirsher */ 1401e689cf4aSJeff Kirsher if (speed == SPEED_1000 && !full_duplex) { 1402e689cf4aSJeff Kirsher val = readl(gp->regs + MAC_TXCFG); 1403e689cf4aSJeff Kirsher writel(val | MAC_TXCFG_TCE, gp->regs + MAC_TXCFG); 1404e689cf4aSJeff Kirsher 1405e689cf4aSJeff Kirsher val = readl(gp->regs + MAC_RXCFG); 1406e689cf4aSJeff Kirsher writel(val | MAC_RXCFG_RCE, gp->regs + MAC_RXCFG); 1407e689cf4aSJeff Kirsher } else { 1408e689cf4aSJeff Kirsher val = readl(gp->regs + MAC_TXCFG); 1409e689cf4aSJeff Kirsher writel(val & ~MAC_TXCFG_TCE, gp->regs + MAC_TXCFG); 1410e689cf4aSJeff Kirsher 1411e689cf4aSJeff Kirsher val = readl(gp->regs + MAC_RXCFG); 1412e689cf4aSJeff Kirsher writel(val & ~MAC_RXCFG_RCE, gp->regs + MAC_RXCFG); 1413e689cf4aSJeff Kirsher } 1414e689cf4aSJeff Kirsher 1415e689cf4aSJeff Kirsher if (gp->phy_type == phy_serialink || 1416e689cf4aSJeff Kirsher gp->phy_type == phy_serdes) { 1417e689cf4aSJeff Kirsher u32 pcs_lpa = readl(gp->regs + PCS_MIILP); 1418e689cf4aSJeff Kirsher 1419e689cf4aSJeff Kirsher if (pcs_lpa & (PCS_MIIADV_SP | PCS_MIIADV_AP)) 1420e689cf4aSJeff Kirsher pause = 1; 1421e689cf4aSJeff Kirsher } 1422e689cf4aSJeff Kirsher 1423e689cf4aSJeff Kirsher if (!full_duplex) 1424e689cf4aSJeff Kirsher writel(512, gp->regs + MAC_STIME); 1425e689cf4aSJeff Kirsher else 1426e689cf4aSJeff Kirsher writel(64, gp->regs + MAC_STIME); 1427e689cf4aSJeff Kirsher val = readl(gp->regs + MAC_MCCFG); 1428e689cf4aSJeff Kirsher if (pause) 1429e689cf4aSJeff Kirsher val |= (MAC_MCCFG_SPE | MAC_MCCFG_RPE); 1430e689cf4aSJeff Kirsher else 1431e689cf4aSJeff Kirsher val &= ~(MAC_MCCFG_SPE | MAC_MCCFG_RPE); 1432e689cf4aSJeff Kirsher writel(val, gp->regs + MAC_MCCFG); 1433e689cf4aSJeff Kirsher 1434e689cf4aSJeff Kirsher gem_start_dma(gp); 1435e689cf4aSJeff Kirsher 1436e689cf4aSJeff Kirsher __netif_tx_unlock(txq); 1437e689cf4aSJeff Kirsher 1438e689cf4aSJeff Kirsher if (netif_msg_link(gp)) { 1439e689cf4aSJeff Kirsher if (pause) { 1440e689cf4aSJeff Kirsher netdev_info(gp->dev, 1441e689cf4aSJeff Kirsher "Pause is enabled (rxfifo: %d off: %d on: %d)\n", 1442e689cf4aSJeff Kirsher gp->rx_fifo_sz, 1443e689cf4aSJeff Kirsher gp->rx_pause_off, 1444e689cf4aSJeff Kirsher gp->rx_pause_on); 1445e689cf4aSJeff Kirsher } else { 1446e689cf4aSJeff Kirsher netdev_info(gp->dev, "Pause is disabled\n"); 1447e689cf4aSJeff Kirsher } 1448e689cf4aSJeff Kirsher } 1449e689cf4aSJeff Kirsher 1450e689cf4aSJeff Kirsher return 0; 1451e689cf4aSJeff Kirsher } 1452e689cf4aSJeff Kirsher 1453e689cf4aSJeff Kirsher static int gem_mdio_link_not_up(struct gem *gp) 1454e689cf4aSJeff Kirsher { 1455e689cf4aSJeff Kirsher switch (gp->lstate) { 1456e689cf4aSJeff Kirsher case link_force_ret: 1457e689cf4aSJeff Kirsher netif_info(gp, link, gp->dev, 1458e689cf4aSJeff Kirsher "Autoneg failed again, keeping forced mode\n"); 1459e689cf4aSJeff Kirsher gp->phy_mii.def->ops->setup_forced(&gp->phy_mii, 1460e689cf4aSJeff Kirsher gp->last_forced_speed, DUPLEX_HALF); 1461e689cf4aSJeff Kirsher gp->timer_ticks = 5; 1462e689cf4aSJeff Kirsher gp->lstate = link_force_ok; 1463e689cf4aSJeff Kirsher return 0; 1464e689cf4aSJeff Kirsher case link_aneg: 1465e689cf4aSJeff Kirsher /* We try forced modes after a failed aneg only on PHYs that don't 1466e689cf4aSJeff Kirsher * have "magic_aneg" bit set, which means they internally do the 1467e689cf4aSJeff Kirsher * while forced-mode thingy. On these, we just restart aneg 1468e689cf4aSJeff Kirsher */ 1469e689cf4aSJeff Kirsher if (gp->phy_mii.def->magic_aneg) 1470e689cf4aSJeff Kirsher return 1; 1471e689cf4aSJeff Kirsher netif_info(gp, link, gp->dev, "switching to forced 100bt\n"); 1472e689cf4aSJeff Kirsher /* Try forced modes. */ 1473e689cf4aSJeff Kirsher gp->phy_mii.def->ops->setup_forced(&gp->phy_mii, SPEED_100, 1474e689cf4aSJeff Kirsher DUPLEX_HALF); 1475e689cf4aSJeff Kirsher gp->timer_ticks = 5; 1476e689cf4aSJeff Kirsher gp->lstate = link_force_try; 1477e689cf4aSJeff Kirsher return 0; 1478e689cf4aSJeff Kirsher case link_force_try: 1479e689cf4aSJeff Kirsher /* Downgrade from 100 to 10 Mbps if necessary. 1480e689cf4aSJeff Kirsher * If already at 10Mbps, warn user about the 1481e689cf4aSJeff Kirsher * situation every 10 ticks. 1482e689cf4aSJeff Kirsher */ 1483e689cf4aSJeff Kirsher if (gp->phy_mii.speed == SPEED_100) { 1484e689cf4aSJeff Kirsher gp->phy_mii.def->ops->setup_forced(&gp->phy_mii, SPEED_10, 1485e689cf4aSJeff Kirsher DUPLEX_HALF); 1486e689cf4aSJeff Kirsher gp->timer_ticks = 5; 1487e689cf4aSJeff Kirsher netif_info(gp, link, gp->dev, 1488e689cf4aSJeff Kirsher "switching to forced 10bt\n"); 1489e689cf4aSJeff Kirsher return 0; 1490e689cf4aSJeff Kirsher } else 1491e689cf4aSJeff Kirsher return 1; 1492e689cf4aSJeff Kirsher default: 1493e689cf4aSJeff Kirsher return 0; 1494e689cf4aSJeff Kirsher } 1495e689cf4aSJeff Kirsher } 1496e689cf4aSJeff Kirsher 1497e689cf4aSJeff Kirsher static void gem_link_timer(unsigned long data) 1498e689cf4aSJeff Kirsher { 1499e689cf4aSJeff Kirsher struct gem *gp = (struct gem *) data; 1500e689cf4aSJeff Kirsher struct net_device *dev = gp->dev; 1501e689cf4aSJeff Kirsher int restart_aneg = 0; 1502e689cf4aSJeff Kirsher 1503e689cf4aSJeff Kirsher /* There's no point doing anything if we're going to be reset */ 1504e689cf4aSJeff Kirsher if (gp->reset_task_pending) 1505e689cf4aSJeff Kirsher return; 1506e689cf4aSJeff Kirsher 1507e689cf4aSJeff Kirsher if (gp->phy_type == phy_serialink || 1508e689cf4aSJeff Kirsher gp->phy_type == phy_serdes) { 1509e689cf4aSJeff Kirsher u32 val = readl(gp->regs + PCS_MIISTAT); 1510e689cf4aSJeff Kirsher 1511e689cf4aSJeff Kirsher if (!(val & PCS_MIISTAT_LS)) 1512e689cf4aSJeff Kirsher val = readl(gp->regs + PCS_MIISTAT); 1513e689cf4aSJeff Kirsher 1514e689cf4aSJeff Kirsher if ((val & PCS_MIISTAT_LS) != 0) { 1515e689cf4aSJeff Kirsher if (gp->lstate == link_up) 1516e689cf4aSJeff Kirsher goto restart; 1517e689cf4aSJeff Kirsher 1518e689cf4aSJeff Kirsher gp->lstate = link_up; 1519e689cf4aSJeff Kirsher netif_carrier_on(dev); 1520e689cf4aSJeff Kirsher (void)gem_set_link_modes(gp); 1521e689cf4aSJeff Kirsher } 1522e689cf4aSJeff Kirsher goto restart; 1523e689cf4aSJeff Kirsher } 1524e689cf4aSJeff Kirsher if (found_mii_phy(gp) && gp->phy_mii.def->ops->poll_link(&gp->phy_mii)) { 1525e689cf4aSJeff Kirsher /* Ok, here we got a link. If we had it due to a forced 1526e689cf4aSJeff Kirsher * fallback, and we were configured for autoneg, we do 1527e689cf4aSJeff Kirsher * retry a short autoneg pass. If you know your hub is 1528e689cf4aSJeff Kirsher * broken, use ethtool ;) 1529e689cf4aSJeff Kirsher */ 1530e689cf4aSJeff Kirsher if (gp->lstate == link_force_try && gp->want_autoneg) { 1531e689cf4aSJeff Kirsher gp->lstate = link_force_ret; 1532e689cf4aSJeff Kirsher gp->last_forced_speed = gp->phy_mii.speed; 1533e689cf4aSJeff Kirsher gp->timer_ticks = 5; 1534e689cf4aSJeff Kirsher if (netif_msg_link(gp)) 1535e689cf4aSJeff Kirsher netdev_info(dev, 1536e689cf4aSJeff Kirsher "Got link after fallback, retrying autoneg once...\n"); 1537e689cf4aSJeff Kirsher gp->phy_mii.def->ops->setup_aneg(&gp->phy_mii, gp->phy_mii.advertising); 1538e689cf4aSJeff Kirsher } else if (gp->lstate != link_up) { 1539e689cf4aSJeff Kirsher gp->lstate = link_up; 1540e689cf4aSJeff Kirsher netif_carrier_on(dev); 1541e689cf4aSJeff Kirsher if (gem_set_link_modes(gp)) 1542e689cf4aSJeff Kirsher restart_aneg = 1; 1543e689cf4aSJeff Kirsher } 1544e689cf4aSJeff Kirsher } else { 1545e689cf4aSJeff Kirsher /* If the link was previously up, we restart the 1546e689cf4aSJeff Kirsher * whole process 1547e689cf4aSJeff Kirsher */ 1548e689cf4aSJeff Kirsher if (gp->lstate == link_up) { 1549e689cf4aSJeff Kirsher gp->lstate = link_down; 1550e689cf4aSJeff Kirsher netif_info(gp, link, dev, "Link down\n"); 1551e689cf4aSJeff Kirsher netif_carrier_off(dev); 1552e689cf4aSJeff Kirsher gem_schedule_reset(gp); 1553e689cf4aSJeff Kirsher /* The reset task will restart the timer */ 1554e689cf4aSJeff Kirsher return; 1555e689cf4aSJeff Kirsher } else if (++gp->timer_ticks > 10) { 1556e689cf4aSJeff Kirsher if (found_mii_phy(gp)) 1557e689cf4aSJeff Kirsher restart_aneg = gem_mdio_link_not_up(gp); 1558e689cf4aSJeff Kirsher else 1559e689cf4aSJeff Kirsher restart_aneg = 1; 1560e689cf4aSJeff Kirsher } 1561e689cf4aSJeff Kirsher } 1562e689cf4aSJeff Kirsher if (restart_aneg) { 1563e689cf4aSJeff Kirsher gem_begin_auto_negotiation(gp, NULL); 1564e689cf4aSJeff Kirsher return; 1565e689cf4aSJeff Kirsher } 1566e689cf4aSJeff Kirsher restart: 1567e689cf4aSJeff Kirsher mod_timer(&gp->link_timer, jiffies + ((12 * HZ) / 10)); 1568e689cf4aSJeff Kirsher } 1569e689cf4aSJeff Kirsher 1570e689cf4aSJeff Kirsher static void gem_clean_rings(struct gem *gp) 1571e689cf4aSJeff Kirsher { 1572e689cf4aSJeff Kirsher struct gem_init_block *gb = gp->init_block; 1573e689cf4aSJeff Kirsher struct sk_buff *skb; 1574e689cf4aSJeff Kirsher int i; 1575e689cf4aSJeff Kirsher dma_addr_t dma_addr; 1576e689cf4aSJeff Kirsher 1577e689cf4aSJeff Kirsher for (i = 0; i < RX_RING_SIZE; i++) { 1578e689cf4aSJeff Kirsher struct gem_rxd *rxd; 1579e689cf4aSJeff Kirsher 1580e689cf4aSJeff Kirsher rxd = &gb->rxd[i]; 1581e689cf4aSJeff Kirsher if (gp->rx_skbs[i] != NULL) { 1582e689cf4aSJeff Kirsher skb = gp->rx_skbs[i]; 1583e689cf4aSJeff Kirsher dma_addr = le64_to_cpu(rxd->buffer); 1584e689cf4aSJeff Kirsher pci_unmap_page(gp->pdev, dma_addr, 1585e689cf4aSJeff Kirsher RX_BUF_ALLOC_SIZE(gp), 1586e689cf4aSJeff Kirsher PCI_DMA_FROMDEVICE); 1587e689cf4aSJeff Kirsher dev_kfree_skb_any(skb); 1588e689cf4aSJeff Kirsher gp->rx_skbs[i] = NULL; 1589e689cf4aSJeff Kirsher } 1590e689cf4aSJeff Kirsher rxd->status_word = 0; 1591e689cf4aSJeff Kirsher wmb(); 1592e689cf4aSJeff Kirsher rxd->buffer = 0; 1593e689cf4aSJeff Kirsher } 1594e689cf4aSJeff Kirsher 1595e689cf4aSJeff Kirsher for (i = 0; i < TX_RING_SIZE; i++) { 1596e689cf4aSJeff Kirsher if (gp->tx_skbs[i] != NULL) { 1597e689cf4aSJeff Kirsher struct gem_txd *txd; 1598e689cf4aSJeff Kirsher int frag; 1599e689cf4aSJeff Kirsher 1600e689cf4aSJeff Kirsher skb = gp->tx_skbs[i]; 1601e689cf4aSJeff Kirsher gp->tx_skbs[i] = NULL; 1602e689cf4aSJeff Kirsher 1603e689cf4aSJeff Kirsher for (frag = 0; frag <= skb_shinfo(skb)->nr_frags; frag++) { 1604e689cf4aSJeff Kirsher int ent = i & (TX_RING_SIZE - 1); 1605e689cf4aSJeff Kirsher 1606e689cf4aSJeff Kirsher txd = &gb->txd[ent]; 1607e689cf4aSJeff Kirsher dma_addr = le64_to_cpu(txd->buffer); 1608e689cf4aSJeff Kirsher pci_unmap_page(gp->pdev, dma_addr, 1609e689cf4aSJeff Kirsher le64_to_cpu(txd->control_word) & 1610e689cf4aSJeff Kirsher TXDCTRL_BUFSZ, PCI_DMA_TODEVICE); 1611e689cf4aSJeff Kirsher 1612e689cf4aSJeff Kirsher if (frag != skb_shinfo(skb)->nr_frags) 1613e689cf4aSJeff Kirsher i++; 1614e689cf4aSJeff Kirsher } 1615e689cf4aSJeff Kirsher dev_kfree_skb_any(skb); 1616e689cf4aSJeff Kirsher } 1617e689cf4aSJeff Kirsher } 1618e689cf4aSJeff Kirsher } 1619e689cf4aSJeff Kirsher 1620e689cf4aSJeff Kirsher static void gem_init_rings(struct gem *gp) 1621e689cf4aSJeff Kirsher { 1622e689cf4aSJeff Kirsher struct gem_init_block *gb = gp->init_block; 1623e689cf4aSJeff Kirsher struct net_device *dev = gp->dev; 1624e689cf4aSJeff Kirsher int i; 1625e689cf4aSJeff Kirsher dma_addr_t dma_addr; 1626e689cf4aSJeff Kirsher 1627e689cf4aSJeff Kirsher gp->rx_new = gp->rx_old = gp->tx_new = gp->tx_old = 0; 1628e689cf4aSJeff Kirsher 1629e689cf4aSJeff Kirsher gem_clean_rings(gp); 1630e689cf4aSJeff Kirsher 1631e689cf4aSJeff Kirsher gp->rx_buf_sz = max(dev->mtu + ETH_HLEN + VLAN_HLEN, 1632e689cf4aSJeff Kirsher (unsigned)VLAN_ETH_FRAME_LEN); 1633e689cf4aSJeff Kirsher 1634e689cf4aSJeff Kirsher for (i = 0; i < RX_RING_SIZE; i++) { 1635e689cf4aSJeff Kirsher struct sk_buff *skb; 1636e689cf4aSJeff Kirsher struct gem_rxd *rxd = &gb->rxd[i]; 1637e689cf4aSJeff Kirsher 1638e689cf4aSJeff Kirsher skb = gem_alloc_skb(dev, RX_BUF_ALLOC_SIZE(gp), GFP_KERNEL); 1639e689cf4aSJeff Kirsher if (!skb) { 1640e689cf4aSJeff Kirsher rxd->buffer = 0; 1641e689cf4aSJeff Kirsher rxd->status_word = 0; 1642e689cf4aSJeff Kirsher continue; 1643e689cf4aSJeff Kirsher } 1644e689cf4aSJeff Kirsher 1645e689cf4aSJeff Kirsher gp->rx_skbs[i] = skb; 1646e689cf4aSJeff Kirsher skb_put(skb, (gp->rx_buf_sz + RX_OFFSET)); 1647e689cf4aSJeff Kirsher dma_addr = pci_map_page(gp->pdev, 1648e689cf4aSJeff Kirsher virt_to_page(skb->data), 1649e689cf4aSJeff Kirsher offset_in_page(skb->data), 1650e689cf4aSJeff Kirsher RX_BUF_ALLOC_SIZE(gp), 1651e689cf4aSJeff Kirsher PCI_DMA_FROMDEVICE); 1652e689cf4aSJeff Kirsher rxd->buffer = cpu_to_le64(dma_addr); 1653e689cf4aSJeff Kirsher wmb(); 1654e689cf4aSJeff Kirsher rxd->status_word = cpu_to_le64(RXDCTRL_FRESH(gp)); 1655e689cf4aSJeff Kirsher skb_reserve(skb, RX_OFFSET); 1656e689cf4aSJeff Kirsher } 1657e689cf4aSJeff Kirsher 1658e689cf4aSJeff Kirsher for (i = 0; i < TX_RING_SIZE; i++) { 1659e689cf4aSJeff Kirsher struct gem_txd *txd = &gb->txd[i]; 1660e689cf4aSJeff Kirsher 1661e689cf4aSJeff Kirsher txd->control_word = 0; 1662e689cf4aSJeff Kirsher wmb(); 1663e689cf4aSJeff Kirsher txd->buffer = 0; 1664e689cf4aSJeff Kirsher } 1665e689cf4aSJeff Kirsher wmb(); 1666e689cf4aSJeff Kirsher } 1667e689cf4aSJeff Kirsher 1668e689cf4aSJeff Kirsher /* Init PHY interface and start link poll state machine */ 1669e689cf4aSJeff Kirsher static void gem_init_phy(struct gem *gp) 1670e689cf4aSJeff Kirsher { 1671e689cf4aSJeff Kirsher u32 mifcfg; 1672e689cf4aSJeff Kirsher 1673e689cf4aSJeff Kirsher /* Revert MIF CFG setting done on stop_phy */ 1674e689cf4aSJeff Kirsher mifcfg = readl(gp->regs + MIF_CFG); 1675e689cf4aSJeff Kirsher mifcfg &= ~MIF_CFG_BBMODE; 1676e689cf4aSJeff Kirsher writel(mifcfg, gp->regs + MIF_CFG); 1677e689cf4aSJeff Kirsher 1678e689cf4aSJeff Kirsher if (gp->pdev->vendor == PCI_VENDOR_ID_APPLE) { 1679e689cf4aSJeff Kirsher int i; 1680e689cf4aSJeff Kirsher 1681e689cf4aSJeff Kirsher /* Those delay sucks, the HW seem to love them though, I'll 1682e689cf4aSJeff Kirsher * serisouly consider breaking some locks here to be able 1683e689cf4aSJeff Kirsher * to schedule instead 1684e689cf4aSJeff Kirsher */ 1685e689cf4aSJeff Kirsher for (i = 0; i < 3; i++) { 1686e689cf4aSJeff Kirsher #ifdef CONFIG_PPC_PMAC 1687e689cf4aSJeff Kirsher pmac_call_feature(PMAC_FTR_GMAC_PHY_RESET, gp->of_node, 0, 0); 1688e689cf4aSJeff Kirsher msleep(20); 1689e689cf4aSJeff Kirsher #endif 1690e689cf4aSJeff Kirsher /* Some PHYs used by apple have problem getting back to us, 1691e689cf4aSJeff Kirsher * we do an additional reset here 1692e689cf4aSJeff Kirsher */ 1693e689cf4aSJeff Kirsher phy_write(gp, MII_BMCR, BMCR_RESET); 1694e689cf4aSJeff Kirsher msleep(20); 1695e689cf4aSJeff Kirsher if (phy_read(gp, MII_BMCR) != 0xffff) 1696e689cf4aSJeff Kirsher break; 1697e689cf4aSJeff Kirsher if (i == 2) 1698e689cf4aSJeff Kirsher netdev_warn(gp->dev, "GMAC PHY not responding !\n"); 1699e689cf4aSJeff Kirsher } 1700e689cf4aSJeff Kirsher } 1701e689cf4aSJeff Kirsher 1702e689cf4aSJeff Kirsher if (gp->pdev->vendor == PCI_VENDOR_ID_SUN && 1703e689cf4aSJeff Kirsher gp->pdev->device == PCI_DEVICE_ID_SUN_GEM) { 1704e689cf4aSJeff Kirsher u32 val; 1705e689cf4aSJeff Kirsher 1706e689cf4aSJeff Kirsher /* Init datapath mode register. */ 1707e689cf4aSJeff Kirsher if (gp->phy_type == phy_mii_mdio0 || 1708e689cf4aSJeff Kirsher gp->phy_type == phy_mii_mdio1) { 1709e689cf4aSJeff Kirsher val = PCS_DMODE_MGM; 1710e689cf4aSJeff Kirsher } else if (gp->phy_type == phy_serialink) { 1711e689cf4aSJeff Kirsher val = PCS_DMODE_SM | PCS_DMODE_GMOE; 1712e689cf4aSJeff Kirsher } else { 1713e689cf4aSJeff Kirsher val = PCS_DMODE_ESM; 1714e689cf4aSJeff Kirsher } 1715e689cf4aSJeff Kirsher 1716e689cf4aSJeff Kirsher writel(val, gp->regs + PCS_DMODE); 1717e689cf4aSJeff Kirsher } 1718e689cf4aSJeff Kirsher 1719e689cf4aSJeff Kirsher if (gp->phy_type == phy_mii_mdio0 || 1720e689cf4aSJeff Kirsher gp->phy_type == phy_mii_mdio1) { 1721e689cf4aSJeff Kirsher /* Reset and detect MII PHY */ 172219e2f6feSDavid S. Miller sungem_phy_probe(&gp->phy_mii, gp->mii_phy_addr); 1723e689cf4aSJeff Kirsher 1724e689cf4aSJeff Kirsher /* Init PHY */ 1725e689cf4aSJeff Kirsher if (gp->phy_mii.def && gp->phy_mii.def->ops->init) 1726e689cf4aSJeff Kirsher gp->phy_mii.def->ops->init(&gp->phy_mii); 1727e689cf4aSJeff Kirsher } else { 1728e689cf4aSJeff Kirsher gem_pcs_reset(gp); 1729e689cf4aSJeff Kirsher gem_pcs_reinit_adv(gp); 1730e689cf4aSJeff Kirsher } 1731e689cf4aSJeff Kirsher 1732e689cf4aSJeff Kirsher /* Default aneg parameters */ 1733e689cf4aSJeff Kirsher gp->timer_ticks = 0; 1734e689cf4aSJeff Kirsher gp->lstate = link_down; 1735e689cf4aSJeff Kirsher netif_carrier_off(gp->dev); 1736e689cf4aSJeff Kirsher 1737e689cf4aSJeff Kirsher /* Print things out */ 1738e689cf4aSJeff Kirsher if (gp->phy_type == phy_mii_mdio0 || 1739e689cf4aSJeff Kirsher gp->phy_type == phy_mii_mdio1) 1740e689cf4aSJeff Kirsher netdev_info(gp->dev, "Found %s PHY\n", 1741e689cf4aSJeff Kirsher gp->phy_mii.def ? gp->phy_mii.def->name : "no"); 1742e689cf4aSJeff Kirsher 1743e689cf4aSJeff Kirsher gem_begin_auto_negotiation(gp, NULL); 1744e689cf4aSJeff Kirsher } 1745e689cf4aSJeff Kirsher 1746e689cf4aSJeff Kirsher static void gem_init_dma(struct gem *gp) 1747e689cf4aSJeff Kirsher { 1748e689cf4aSJeff Kirsher u64 desc_dma = (u64) gp->gblock_dvma; 1749e689cf4aSJeff Kirsher u32 val; 1750e689cf4aSJeff Kirsher 1751e689cf4aSJeff Kirsher val = (TXDMA_CFG_BASE | (0x7ff << 10) | TXDMA_CFG_PMODE); 1752e689cf4aSJeff Kirsher writel(val, gp->regs + TXDMA_CFG); 1753e689cf4aSJeff Kirsher 1754e689cf4aSJeff Kirsher writel(desc_dma >> 32, gp->regs + TXDMA_DBHI); 1755e689cf4aSJeff Kirsher writel(desc_dma & 0xffffffff, gp->regs + TXDMA_DBLOW); 1756e689cf4aSJeff Kirsher desc_dma += (INIT_BLOCK_TX_RING_SIZE * sizeof(struct gem_txd)); 1757e689cf4aSJeff Kirsher 1758e689cf4aSJeff Kirsher writel(0, gp->regs + TXDMA_KICK); 1759e689cf4aSJeff Kirsher 1760e689cf4aSJeff Kirsher val = (RXDMA_CFG_BASE | (RX_OFFSET << 10) | 1761e689cf4aSJeff Kirsher ((14 / 2) << 13) | RXDMA_CFG_FTHRESH_128); 1762e689cf4aSJeff Kirsher writel(val, gp->regs + RXDMA_CFG); 1763e689cf4aSJeff Kirsher 1764e689cf4aSJeff Kirsher writel(desc_dma >> 32, gp->regs + RXDMA_DBHI); 1765e689cf4aSJeff Kirsher writel(desc_dma & 0xffffffff, gp->regs + RXDMA_DBLOW); 1766e689cf4aSJeff Kirsher 1767e689cf4aSJeff Kirsher writel(RX_RING_SIZE - 4, gp->regs + RXDMA_KICK); 1768e689cf4aSJeff Kirsher 1769e689cf4aSJeff Kirsher val = (((gp->rx_pause_off / 64) << 0) & RXDMA_PTHRESH_OFF); 1770e689cf4aSJeff Kirsher val |= (((gp->rx_pause_on / 64) << 12) & RXDMA_PTHRESH_ON); 1771e689cf4aSJeff Kirsher writel(val, gp->regs + RXDMA_PTHRESH); 1772e689cf4aSJeff Kirsher 1773e689cf4aSJeff Kirsher if (readl(gp->regs + GREG_BIFCFG) & GREG_BIFCFG_M66EN) 1774e689cf4aSJeff Kirsher writel(((5 & RXDMA_BLANK_IPKTS) | 1775e689cf4aSJeff Kirsher ((8 << 12) & RXDMA_BLANK_ITIME)), 1776e689cf4aSJeff Kirsher gp->regs + RXDMA_BLANK); 1777e689cf4aSJeff Kirsher else 1778e689cf4aSJeff Kirsher writel(((5 & RXDMA_BLANK_IPKTS) | 1779e689cf4aSJeff Kirsher ((4 << 12) & RXDMA_BLANK_ITIME)), 1780e689cf4aSJeff Kirsher gp->regs + RXDMA_BLANK); 1781e689cf4aSJeff Kirsher } 1782e689cf4aSJeff Kirsher 1783e689cf4aSJeff Kirsher static u32 gem_setup_multicast(struct gem *gp) 1784e689cf4aSJeff Kirsher { 1785e689cf4aSJeff Kirsher u32 rxcfg = 0; 1786e689cf4aSJeff Kirsher int i; 1787e689cf4aSJeff Kirsher 1788e689cf4aSJeff Kirsher if ((gp->dev->flags & IFF_ALLMULTI) || 1789e689cf4aSJeff Kirsher (netdev_mc_count(gp->dev) > 256)) { 1790e689cf4aSJeff Kirsher for (i=0; i<16; i++) 1791e689cf4aSJeff Kirsher writel(0xffff, gp->regs + MAC_HASH0 + (i << 2)); 1792e689cf4aSJeff Kirsher rxcfg |= MAC_RXCFG_HFE; 1793e689cf4aSJeff Kirsher } else if (gp->dev->flags & IFF_PROMISC) { 1794e689cf4aSJeff Kirsher rxcfg |= MAC_RXCFG_PROM; 1795e689cf4aSJeff Kirsher } else { 1796e689cf4aSJeff Kirsher u16 hash_table[16]; 1797e689cf4aSJeff Kirsher u32 crc; 1798e689cf4aSJeff Kirsher struct netdev_hw_addr *ha; 1799e689cf4aSJeff Kirsher int i; 1800e689cf4aSJeff Kirsher 1801e689cf4aSJeff Kirsher memset(hash_table, 0, sizeof(hash_table)); 1802e689cf4aSJeff Kirsher netdev_for_each_mc_addr(ha, gp->dev) { 1803e689cf4aSJeff Kirsher crc = ether_crc_le(6, ha->addr); 1804e689cf4aSJeff Kirsher crc >>= 24; 1805e689cf4aSJeff Kirsher hash_table[crc >> 4] |= 1 << (15 - (crc & 0xf)); 1806e689cf4aSJeff Kirsher } 1807e689cf4aSJeff Kirsher for (i=0; i<16; i++) 1808e689cf4aSJeff Kirsher writel(hash_table[i], gp->regs + MAC_HASH0 + (i << 2)); 1809e689cf4aSJeff Kirsher rxcfg |= MAC_RXCFG_HFE; 1810e689cf4aSJeff Kirsher } 1811e689cf4aSJeff Kirsher 1812e689cf4aSJeff Kirsher return rxcfg; 1813e689cf4aSJeff Kirsher } 1814e689cf4aSJeff Kirsher 1815e689cf4aSJeff Kirsher static void gem_init_mac(struct gem *gp) 1816e689cf4aSJeff Kirsher { 1817e689cf4aSJeff Kirsher unsigned char *e = &gp->dev->dev_addr[0]; 1818e689cf4aSJeff Kirsher 1819e689cf4aSJeff Kirsher writel(0x1bf0, gp->regs + MAC_SNDPAUSE); 1820e689cf4aSJeff Kirsher 1821e689cf4aSJeff Kirsher writel(0x00, gp->regs + MAC_IPG0); 1822e689cf4aSJeff Kirsher writel(0x08, gp->regs + MAC_IPG1); 1823e689cf4aSJeff Kirsher writel(0x04, gp->regs + MAC_IPG2); 1824e689cf4aSJeff Kirsher writel(0x40, gp->regs + MAC_STIME); 1825e689cf4aSJeff Kirsher writel(0x40, gp->regs + MAC_MINFSZ); 1826e689cf4aSJeff Kirsher 1827e689cf4aSJeff Kirsher /* Ethernet payload + header + FCS + optional VLAN tag. */ 1828e689cf4aSJeff Kirsher writel(0x20000000 | (gp->rx_buf_sz + 4), gp->regs + MAC_MAXFSZ); 1829e689cf4aSJeff Kirsher 1830e689cf4aSJeff Kirsher writel(0x07, gp->regs + MAC_PASIZE); 1831e689cf4aSJeff Kirsher writel(0x04, gp->regs + MAC_JAMSIZE); 1832e689cf4aSJeff Kirsher writel(0x10, gp->regs + MAC_ATTLIM); 1833e689cf4aSJeff Kirsher writel(0x8808, gp->regs + MAC_MCTYPE); 1834e689cf4aSJeff Kirsher 1835e689cf4aSJeff Kirsher writel((e[5] | (e[4] << 8)) & 0x3ff, gp->regs + MAC_RANDSEED); 1836e689cf4aSJeff Kirsher 1837e689cf4aSJeff Kirsher writel((e[4] << 8) | e[5], gp->regs + MAC_ADDR0); 1838e689cf4aSJeff Kirsher writel((e[2] << 8) | e[3], gp->regs + MAC_ADDR1); 1839e689cf4aSJeff Kirsher writel((e[0] << 8) | e[1], gp->regs + MAC_ADDR2); 1840e689cf4aSJeff Kirsher 1841e689cf4aSJeff Kirsher writel(0, gp->regs + MAC_ADDR3); 1842e689cf4aSJeff Kirsher writel(0, gp->regs + MAC_ADDR4); 1843e689cf4aSJeff Kirsher writel(0, gp->regs + MAC_ADDR5); 1844e689cf4aSJeff Kirsher 1845e689cf4aSJeff Kirsher writel(0x0001, gp->regs + MAC_ADDR6); 1846e689cf4aSJeff Kirsher writel(0xc200, gp->regs + MAC_ADDR7); 1847e689cf4aSJeff Kirsher writel(0x0180, gp->regs + MAC_ADDR8); 1848e689cf4aSJeff Kirsher 1849e689cf4aSJeff Kirsher writel(0, gp->regs + MAC_AFILT0); 1850e689cf4aSJeff Kirsher writel(0, gp->regs + MAC_AFILT1); 1851e689cf4aSJeff Kirsher writel(0, gp->regs + MAC_AFILT2); 1852e689cf4aSJeff Kirsher writel(0, gp->regs + MAC_AF21MSK); 1853e689cf4aSJeff Kirsher writel(0, gp->regs + MAC_AF0MSK); 1854e689cf4aSJeff Kirsher 1855e689cf4aSJeff Kirsher gp->mac_rx_cfg = gem_setup_multicast(gp); 1856e689cf4aSJeff Kirsher #ifdef STRIP_FCS 1857e689cf4aSJeff Kirsher gp->mac_rx_cfg |= MAC_RXCFG_SFCS; 1858e689cf4aSJeff Kirsher #endif 1859e689cf4aSJeff Kirsher writel(0, gp->regs + MAC_NCOLL); 1860e689cf4aSJeff Kirsher writel(0, gp->regs + MAC_FASUCC); 1861e689cf4aSJeff Kirsher writel(0, gp->regs + MAC_ECOLL); 1862e689cf4aSJeff Kirsher writel(0, gp->regs + MAC_LCOLL); 1863e689cf4aSJeff Kirsher writel(0, gp->regs + MAC_DTIMER); 1864e689cf4aSJeff Kirsher writel(0, gp->regs + MAC_PATMPS); 1865e689cf4aSJeff Kirsher writel(0, gp->regs + MAC_RFCTR); 1866e689cf4aSJeff Kirsher writel(0, gp->regs + MAC_LERR); 1867e689cf4aSJeff Kirsher writel(0, gp->regs + MAC_AERR); 1868e689cf4aSJeff Kirsher writel(0, gp->regs + MAC_FCSERR); 1869e689cf4aSJeff Kirsher writel(0, gp->regs + MAC_RXCVERR); 1870e689cf4aSJeff Kirsher 1871e689cf4aSJeff Kirsher /* Clear RX/TX/MAC/XIF config, we will set these up and enable 1872e689cf4aSJeff Kirsher * them once a link is established. 1873e689cf4aSJeff Kirsher */ 1874e689cf4aSJeff Kirsher writel(0, gp->regs + MAC_TXCFG); 1875e689cf4aSJeff Kirsher writel(gp->mac_rx_cfg, gp->regs + MAC_RXCFG); 1876e689cf4aSJeff Kirsher writel(0, gp->regs + MAC_MCCFG); 1877e689cf4aSJeff Kirsher writel(0, gp->regs + MAC_XIFCFG); 1878e689cf4aSJeff Kirsher 1879e689cf4aSJeff Kirsher /* Setup MAC interrupts. We want to get all of the interesting 1880e689cf4aSJeff Kirsher * counter expiration events, but we do not want to hear about 1881e689cf4aSJeff Kirsher * normal rx/tx as the DMA engine tells us that. 1882e689cf4aSJeff Kirsher */ 1883e689cf4aSJeff Kirsher writel(MAC_TXSTAT_XMIT, gp->regs + MAC_TXMASK); 1884e689cf4aSJeff Kirsher writel(MAC_RXSTAT_RCV, gp->regs + MAC_RXMASK); 1885e689cf4aSJeff Kirsher 1886e689cf4aSJeff Kirsher /* Don't enable even the PAUSE interrupts for now, we 1887e689cf4aSJeff Kirsher * make no use of those events other than to record them. 1888e689cf4aSJeff Kirsher */ 1889e689cf4aSJeff Kirsher writel(0xffffffff, gp->regs + MAC_MCMASK); 1890e689cf4aSJeff Kirsher 1891e689cf4aSJeff Kirsher /* Don't enable GEM's WOL in normal operations 1892e689cf4aSJeff Kirsher */ 1893e689cf4aSJeff Kirsher if (gp->has_wol) 1894e689cf4aSJeff Kirsher writel(0, gp->regs + WOL_WAKECSR); 1895e689cf4aSJeff Kirsher } 1896e689cf4aSJeff Kirsher 1897e689cf4aSJeff Kirsher static void gem_init_pause_thresholds(struct gem *gp) 1898e689cf4aSJeff Kirsher { 1899e689cf4aSJeff Kirsher u32 cfg; 1900e689cf4aSJeff Kirsher 1901e689cf4aSJeff Kirsher /* Calculate pause thresholds. Setting the OFF threshold to the 1902e689cf4aSJeff Kirsher * full RX fifo size effectively disables PAUSE generation which 1903e689cf4aSJeff Kirsher * is what we do for 10/100 only GEMs which have FIFOs too small 1904e689cf4aSJeff Kirsher * to make real gains from PAUSE. 1905e689cf4aSJeff Kirsher */ 1906e689cf4aSJeff Kirsher if (gp->rx_fifo_sz <= (2 * 1024)) { 1907e689cf4aSJeff Kirsher gp->rx_pause_off = gp->rx_pause_on = gp->rx_fifo_sz; 1908e689cf4aSJeff Kirsher } else { 1909e689cf4aSJeff Kirsher int max_frame = (gp->rx_buf_sz + 4 + 64) & ~63; 1910e689cf4aSJeff Kirsher int off = (gp->rx_fifo_sz - (max_frame * 2)); 1911e689cf4aSJeff Kirsher int on = off - max_frame; 1912e689cf4aSJeff Kirsher 1913e689cf4aSJeff Kirsher gp->rx_pause_off = off; 1914e689cf4aSJeff Kirsher gp->rx_pause_on = on; 1915e689cf4aSJeff Kirsher } 1916e689cf4aSJeff Kirsher 1917e689cf4aSJeff Kirsher 1918e689cf4aSJeff Kirsher /* Configure the chip "burst" DMA mode & enable some 1919e689cf4aSJeff Kirsher * HW bug fixes on Apple version 1920e689cf4aSJeff Kirsher */ 1921e689cf4aSJeff Kirsher cfg = 0; 1922e689cf4aSJeff Kirsher if (gp->pdev->vendor == PCI_VENDOR_ID_APPLE) 1923e689cf4aSJeff Kirsher cfg |= GREG_CFG_RONPAULBIT | GREG_CFG_ENBUG2FIX; 1924e689cf4aSJeff Kirsher #if !defined(CONFIG_SPARC64) && !defined(CONFIG_ALPHA) 1925e689cf4aSJeff Kirsher cfg |= GREG_CFG_IBURST; 1926e689cf4aSJeff Kirsher #endif 1927e689cf4aSJeff Kirsher cfg |= ((31 << 1) & GREG_CFG_TXDMALIM); 1928e689cf4aSJeff Kirsher cfg |= ((31 << 6) & GREG_CFG_RXDMALIM); 1929e689cf4aSJeff Kirsher writel(cfg, gp->regs + GREG_CFG); 1930e689cf4aSJeff Kirsher 1931e689cf4aSJeff Kirsher /* If Infinite Burst didn't stick, then use different 1932e689cf4aSJeff Kirsher * thresholds (and Apple bug fixes don't exist) 1933e689cf4aSJeff Kirsher */ 1934e689cf4aSJeff Kirsher if (!(readl(gp->regs + GREG_CFG) & GREG_CFG_IBURST)) { 1935e689cf4aSJeff Kirsher cfg = ((2 << 1) & GREG_CFG_TXDMALIM); 1936e689cf4aSJeff Kirsher cfg |= ((8 << 6) & GREG_CFG_RXDMALIM); 1937e689cf4aSJeff Kirsher writel(cfg, gp->regs + GREG_CFG); 1938e689cf4aSJeff Kirsher } 1939e689cf4aSJeff Kirsher } 1940e689cf4aSJeff Kirsher 1941e689cf4aSJeff Kirsher static int gem_check_invariants(struct gem *gp) 1942e689cf4aSJeff Kirsher { 1943e689cf4aSJeff Kirsher struct pci_dev *pdev = gp->pdev; 1944e689cf4aSJeff Kirsher u32 mif_cfg; 1945e689cf4aSJeff Kirsher 1946e689cf4aSJeff Kirsher /* On Apple's sungem, we can't rely on registers as the chip 1947e689cf4aSJeff Kirsher * was been powered down by the firmware. The PHY is looked 1948e689cf4aSJeff Kirsher * up later on. 1949e689cf4aSJeff Kirsher */ 1950e689cf4aSJeff Kirsher if (pdev->vendor == PCI_VENDOR_ID_APPLE) { 1951e689cf4aSJeff Kirsher gp->phy_type = phy_mii_mdio0; 1952e689cf4aSJeff Kirsher gp->tx_fifo_sz = readl(gp->regs + TXDMA_FSZ) * 64; 1953e689cf4aSJeff Kirsher gp->rx_fifo_sz = readl(gp->regs + RXDMA_FSZ) * 64; 1954e689cf4aSJeff Kirsher gp->swrst_base = 0; 1955e689cf4aSJeff Kirsher 1956e689cf4aSJeff Kirsher mif_cfg = readl(gp->regs + MIF_CFG); 1957e689cf4aSJeff Kirsher mif_cfg &= ~(MIF_CFG_PSELECT|MIF_CFG_POLL|MIF_CFG_BBMODE|MIF_CFG_MDI1); 1958e689cf4aSJeff Kirsher mif_cfg |= MIF_CFG_MDI0; 1959e689cf4aSJeff Kirsher writel(mif_cfg, gp->regs + MIF_CFG); 1960e689cf4aSJeff Kirsher writel(PCS_DMODE_MGM, gp->regs + PCS_DMODE); 1961e689cf4aSJeff Kirsher writel(MAC_XIFCFG_OE, gp->regs + MAC_XIFCFG); 1962e689cf4aSJeff Kirsher 1963e689cf4aSJeff Kirsher /* We hard-code the PHY address so we can properly bring it out of 1964e689cf4aSJeff Kirsher * reset later on, we can't really probe it at this point, though 1965e689cf4aSJeff Kirsher * that isn't an issue. 1966e689cf4aSJeff Kirsher */ 1967e689cf4aSJeff Kirsher if (gp->pdev->device == PCI_DEVICE_ID_APPLE_K2_GMAC) 1968e689cf4aSJeff Kirsher gp->mii_phy_addr = 1; 1969e689cf4aSJeff Kirsher else 1970e689cf4aSJeff Kirsher gp->mii_phy_addr = 0; 1971e689cf4aSJeff Kirsher 1972e689cf4aSJeff Kirsher return 0; 1973e689cf4aSJeff Kirsher } 1974e689cf4aSJeff Kirsher 1975e689cf4aSJeff Kirsher mif_cfg = readl(gp->regs + MIF_CFG); 1976e689cf4aSJeff Kirsher 1977e689cf4aSJeff Kirsher if (pdev->vendor == PCI_VENDOR_ID_SUN && 1978e689cf4aSJeff Kirsher pdev->device == PCI_DEVICE_ID_SUN_RIO_GEM) { 1979e689cf4aSJeff Kirsher /* One of the MII PHYs _must_ be present 1980e689cf4aSJeff Kirsher * as this chip has no gigabit PHY. 1981e689cf4aSJeff Kirsher */ 1982e689cf4aSJeff Kirsher if ((mif_cfg & (MIF_CFG_MDI0 | MIF_CFG_MDI1)) == 0) { 1983e689cf4aSJeff Kirsher pr_err("RIO GEM lacks MII phy, mif_cfg[%08x]\n", 1984e689cf4aSJeff Kirsher mif_cfg); 1985e689cf4aSJeff Kirsher return -1; 1986e689cf4aSJeff Kirsher } 1987e689cf4aSJeff Kirsher } 1988e689cf4aSJeff Kirsher 1989e689cf4aSJeff Kirsher /* Determine initial PHY interface type guess. MDIO1 is the 1990e689cf4aSJeff Kirsher * external PHY and thus takes precedence over MDIO0. 1991e689cf4aSJeff Kirsher */ 1992e689cf4aSJeff Kirsher 1993e689cf4aSJeff Kirsher if (mif_cfg & MIF_CFG_MDI1) { 1994e689cf4aSJeff Kirsher gp->phy_type = phy_mii_mdio1; 1995e689cf4aSJeff Kirsher mif_cfg |= MIF_CFG_PSELECT; 1996e689cf4aSJeff Kirsher writel(mif_cfg, gp->regs + MIF_CFG); 1997e689cf4aSJeff Kirsher } else if (mif_cfg & MIF_CFG_MDI0) { 1998e689cf4aSJeff Kirsher gp->phy_type = phy_mii_mdio0; 1999e689cf4aSJeff Kirsher mif_cfg &= ~MIF_CFG_PSELECT; 2000e689cf4aSJeff Kirsher writel(mif_cfg, gp->regs + MIF_CFG); 2001e689cf4aSJeff Kirsher } else { 2002e689cf4aSJeff Kirsher #ifdef CONFIG_SPARC 2003e689cf4aSJeff Kirsher const char *p; 2004e689cf4aSJeff Kirsher 2005e689cf4aSJeff Kirsher p = of_get_property(gp->of_node, "shared-pins", NULL); 2006e689cf4aSJeff Kirsher if (p && !strcmp(p, "serdes")) 2007e689cf4aSJeff Kirsher gp->phy_type = phy_serdes; 2008e689cf4aSJeff Kirsher else 2009e689cf4aSJeff Kirsher #endif 2010e689cf4aSJeff Kirsher gp->phy_type = phy_serialink; 2011e689cf4aSJeff Kirsher } 2012e689cf4aSJeff Kirsher if (gp->phy_type == phy_mii_mdio1 || 2013e689cf4aSJeff Kirsher gp->phy_type == phy_mii_mdio0) { 2014e689cf4aSJeff Kirsher int i; 2015e689cf4aSJeff Kirsher 2016e689cf4aSJeff Kirsher for (i = 0; i < 32; i++) { 2017e689cf4aSJeff Kirsher gp->mii_phy_addr = i; 2018e689cf4aSJeff Kirsher if (phy_read(gp, MII_BMCR) != 0xffff) 2019e689cf4aSJeff Kirsher break; 2020e689cf4aSJeff Kirsher } 2021e689cf4aSJeff Kirsher if (i == 32) { 2022e689cf4aSJeff Kirsher if (pdev->device != PCI_DEVICE_ID_SUN_GEM) { 2023e689cf4aSJeff Kirsher pr_err("RIO MII phy will not respond\n"); 2024e689cf4aSJeff Kirsher return -1; 2025e689cf4aSJeff Kirsher } 2026e689cf4aSJeff Kirsher gp->phy_type = phy_serdes; 2027e689cf4aSJeff Kirsher } 2028e689cf4aSJeff Kirsher } 2029e689cf4aSJeff Kirsher 2030e689cf4aSJeff Kirsher /* Fetch the FIFO configurations now too. */ 2031e689cf4aSJeff Kirsher gp->tx_fifo_sz = readl(gp->regs + TXDMA_FSZ) * 64; 2032e689cf4aSJeff Kirsher gp->rx_fifo_sz = readl(gp->regs + RXDMA_FSZ) * 64; 2033e689cf4aSJeff Kirsher 2034e689cf4aSJeff Kirsher if (pdev->vendor == PCI_VENDOR_ID_SUN) { 2035e689cf4aSJeff Kirsher if (pdev->device == PCI_DEVICE_ID_SUN_GEM) { 2036e689cf4aSJeff Kirsher if (gp->tx_fifo_sz != (9 * 1024) || 2037e689cf4aSJeff Kirsher gp->rx_fifo_sz != (20 * 1024)) { 2038e689cf4aSJeff Kirsher pr_err("GEM has bogus fifo sizes tx(%d) rx(%d)\n", 2039e689cf4aSJeff Kirsher gp->tx_fifo_sz, gp->rx_fifo_sz); 2040e689cf4aSJeff Kirsher return -1; 2041e689cf4aSJeff Kirsher } 2042e689cf4aSJeff Kirsher gp->swrst_base = 0; 2043e689cf4aSJeff Kirsher } else { 2044e689cf4aSJeff Kirsher if (gp->tx_fifo_sz != (2 * 1024) || 2045e689cf4aSJeff Kirsher gp->rx_fifo_sz != (2 * 1024)) { 2046e689cf4aSJeff Kirsher pr_err("RIO GEM has bogus fifo sizes tx(%d) rx(%d)\n", 2047e689cf4aSJeff Kirsher gp->tx_fifo_sz, gp->rx_fifo_sz); 2048e689cf4aSJeff Kirsher return -1; 2049e689cf4aSJeff Kirsher } 2050e689cf4aSJeff Kirsher gp->swrst_base = (64 / 4) << GREG_SWRST_CACHE_SHIFT; 2051e689cf4aSJeff Kirsher } 2052e689cf4aSJeff Kirsher } 2053e689cf4aSJeff Kirsher 2054e689cf4aSJeff Kirsher return 0; 2055e689cf4aSJeff Kirsher } 2056e689cf4aSJeff Kirsher 2057e689cf4aSJeff Kirsher static void gem_reinit_chip(struct gem *gp) 2058e689cf4aSJeff Kirsher { 2059e689cf4aSJeff Kirsher /* Reset the chip */ 2060e689cf4aSJeff Kirsher gem_reset(gp); 2061e689cf4aSJeff Kirsher 2062e689cf4aSJeff Kirsher /* Make sure ints are disabled */ 2063e689cf4aSJeff Kirsher gem_disable_ints(gp); 2064e689cf4aSJeff Kirsher 2065e689cf4aSJeff Kirsher /* Allocate & setup ring buffers */ 2066e689cf4aSJeff Kirsher gem_init_rings(gp); 2067e689cf4aSJeff Kirsher 2068e689cf4aSJeff Kirsher /* Configure pause thresholds */ 2069e689cf4aSJeff Kirsher gem_init_pause_thresholds(gp); 2070e689cf4aSJeff Kirsher 2071e689cf4aSJeff Kirsher /* Init DMA & MAC engines */ 2072e689cf4aSJeff Kirsher gem_init_dma(gp); 2073e689cf4aSJeff Kirsher gem_init_mac(gp); 2074e689cf4aSJeff Kirsher } 2075e689cf4aSJeff Kirsher 2076e689cf4aSJeff Kirsher 2077e689cf4aSJeff Kirsher static void gem_stop_phy(struct gem *gp, int wol) 2078e689cf4aSJeff Kirsher { 2079e689cf4aSJeff Kirsher u32 mifcfg; 2080e689cf4aSJeff Kirsher 2081e689cf4aSJeff Kirsher /* Let the chip settle down a bit, it seems that helps 2082e689cf4aSJeff Kirsher * for sleep mode on some models 2083e689cf4aSJeff Kirsher */ 2084e689cf4aSJeff Kirsher msleep(10); 2085e689cf4aSJeff Kirsher 2086e689cf4aSJeff Kirsher /* Make sure we aren't polling PHY status change. We 2087e689cf4aSJeff Kirsher * don't currently use that feature though 2088e689cf4aSJeff Kirsher */ 2089e689cf4aSJeff Kirsher mifcfg = readl(gp->regs + MIF_CFG); 2090e689cf4aSJeff Kirsher mifcfg &= ~MIF_CFG_POLL; 2091e689cf4aSJeff Kirsher writel(mifcfg, gp->regs + MIF_CFG); 2092e689cf4aSJeff Kirsher 2093e689cf4aSJeff Kirsher if (wol && gp->has_wol) { 2094e689cf4aSJeff Kirsher unsigned char *e = &gp->dev->dev_addr[0]; 2095e689cf4aSJeff Kirsher u32 csr; 2096e689cf4aSJeff Kirsher 2097e689cf4aSJeff Kirsher /* Setup wake-on-lan for MAGIC packet */ 2098e689cf4aSJeff Kirsher writel(MAC_RXCFG_HFE | MAC_RXCFG_SFCS | MAC_RXCFG_ENAB, 2099e689cf4aSJeff Kirsher gp->regs + MAC_RXCFG); 2100e689cf4aSJeff Kirsher writel((e[4] << 8) | e[5], gp->regs + WOL_MATCH0); 2101e689cf4aSJeff Kirsher writel((e[2] << 8) | e[3], gp->regs + WOL_MATCH1); 2102e689cf4aSJeff Kirsher writel((e[0] << 8) | e[1], gp->regs + WOL_MATCH2); 2103e689cf4aSJeff Kirsher 2104e689cf4aSJeff Kirsher writel(WOL_MCOUNT_N | WOL_MCOUNT_M, gp->regs + WOL_MCOUNT); 2105e689cf4aSJeff Kirsher csr = WOL_WAKECSR_ENABLE; 2106e689cf4aSJeff Kirsher if ((readl(gp->regs + MAC_XIFCFG) & MAC_XIFCFG_GMII) == 0) 2107e689cf4aSJeff Kirsher csr |= WOL_WAKECSR_MII; 2108e689cf4aSJeff Kirsher writel(csr, gp->regs + WOL_WAKECSR); 2109e689cf4aSJeff Kirsher } else { 2110e689cf4aSJeff Kirsher writel(0, gp->regs + MAC_RXCFG); 2111e689cf4aSJeff Kirsher (void)readl(gp->regs + MAC_RXCFG); 2112e689cf4aSJeff Kirsher /* Machine sleep will die in strange ways if we 2113e689cf4aSJeff Kirsher * dont wait a bit here, looks like the chip takes 2114e689cf4aSJeff Kirsher * some time to really shut down 2115e689cf4aSJeff Kirsher */ 2116e689cf4aSJeff Kirsher msleep(10); 2117e689cf4aSJeff Kirsher } 2118e689cf4aSJeff Kirsher 2119e689cf4aSJeff Kirsher writel(0, gp->regs + MAC_TXCFG); 2120e689cf4aSJeff Kirsher writel(0, gp->regs + MAC_XIFCFG); 2121e689cf4aSJeff Kirsher writel(0, gp->regs + TXDMA_CFG); 2122e689cf4aSJeff Kirsher writel(0, gp->regs + RXDMA_CFG); 2123e689cf4aSJeff Kirsher 2124e689cf4aSJeff Kirsher if (!wol) { 2125e689cf4aSJeff Kirsher gem_reset(gp); 2126e689cf4aSJeff Kirsher writel(MAC_TXRST_CMD, gp->regs + MAC_TXRST); 2127e689cf4aSJeff Kirsher writel(MAC_RXRST_CMD, gp->regs + MAC_RXRST); 2128e689cf4aSJeff Kirsher 2129e689cf4aSJeff Kirsher if (found_mii_phy(gp) && gp->phy_mii.def->ops->suspend) 2130e689cf4aSJeff Kirsher gp->phy_mii.def->ops->suspend(&gp->phy_mii); 2131e689cf4aSJeff Kirsher 2132e689cf4aSJeff Kirsher /* According to Apple, we must set the MDIO pins to this begnign 2133e689cf4aSJeff Kirsher * state or we may 1) eat more current, 2) damage some PHYs 2134e689cf4aSJeff Kirsher */ 2135e689cf4aSJeff Kirsher writel(mifcfg | MIF_CFG_BBMODE, gp->regs + MIF_CFG); 2136e689cf4aSJeff Kirsher writel(0, gp->regs + MIF_BBCLK); 2137e689cf4aSJeff Kirsher writel(0, gp->regs + MIF_BBDATA); 2138e689cf4aSJeff Kirsher writel(0, gp->regs + MIF_BBOENAB); 2139e689cf4aSJeff Kirsher writel(MAC_XIFCFG_GMII | MAC_XIFCFG_LBCK, gp->regs + MAC_XIFCFG); 2140e689cf4aSJeff Kirsher (void) readl(gp->regs + MAC_XIFCFG); 2141e689cf4aSJeff Kirsher } 2142e689cf4aSJeff Kirsher } 2143e689cf4aSJeff Kirsher 2144e689cf4aSJeff Kirsher static int gem_do_start(struct net_device *dev) 2145e689cf4aSJeff Kirsher { 2146e689cf4aSJeff Kirsher struct gem *gp = netdev_priv(dev); 2147e689cf4aSJeff Kirsher int rc; 2148e689cf4aSJeff Kirsher 2149e689cf4aSJeff Kirsher /* Enable the cell */ 2150e689cf4aSJeff Kirsher gem_get_cell(gp); 2151e689cf4aSJeff Kirsher 2152e689cf4aSJeff Kirsher /* Make sure PCI access and bus master are enabled */ 2153e689cf4aSJeff Kirsher rc = pci_enable_device(gp->pdev); 2154e689cf4aSJeff Kirsher if (rc) { 2155e689cf4aSJeff Kirsher netdev_err(dev, "Failed to enable chip on PCI bus !\n"); 2156e689cf4aSJeff Kirsher 2157e689cf4aSJeff Kirsher /* Put cell and forget it for now, it will be considered as 2158e689cf4aSJeff Kirsher * still asleep, a new sleep cycle may bring it back 2159e689cf4aSJeff Kirsher */ 2160e689cf4aSJeff Kirsher gem_put_cell(gp); 2161e689cf4aSJeff Kirsher return -ENXIO; 2162e689cf4aSJeff Kirsher } 2163e689cf4aSJeff Kirsher pci_set_master(gp->pdev); 2164e689cf4aSJeff Kirsher 2165e689cf4aSJeff Kirsher /* Init & setup chip hardware */ 2166e689cf4aSJeff Kirsher gem_reinit_chip(gp); 2167e689cf4aSJeff Kirsher 2168e689cf4aSJeff Kirsher /* An interrupt might come in handy */ 2169e689cf4aSJeff Kirsher rc = request_irq(gp->pdev->irq, gem_interrupt, 2170e689cf4aSJeff Kirsher IRQF_SHARED, dev->name, (void *)dev); 2171e689cf4aSJeff Kirsher if (rc) { 2172e689cf4aSJeff Kirsher netdev_err(dev, "failed to request irq !\n"); 2173e689cf4aSJeff Kirsher 2174e689cf4aSJeff Kirsher gem_reset(gp); 2175e689cf4aSJeff Kirsher gem_clean_rings(gp); 2176e689cf4aSJeff Kirsher gem_put_cell(gp); 2177e689cf4aSJeff Kirsher return rc; 2178e689cf4aSJeff Kirsher } 2179e689cf4aSJeff Kirsher 2180e689cf4aSJeff Kirsher /* Mark us as attached again if we come from resume(), this has 2181e689cf4aSJeff Kirsher * no effect if we weren't detatched and needs to be done now. 2182e689cf4aSJeff Kirsher */ 2183e689cf4aSJeff Kirsher netif_device_attach(dev); 2184e689cf4aSJeff Kirsher 2185e689cf4aSJeff Kirsher /* Restart NAPI & queues */ 2186e689cf4aSJeff Kirsher gem_netif_start(gp); 2187e689cf4aSJeff Kirsher 2188e689cf4aSJeff Kirsher /* Detect & init PHY, start autoneg etc... this will 2189e689cf4aSJeff Kirsher * eventually result in starting DMA operations when 2190e689cf4aSJeff Kirsher * the link is up 2191e689cf4aSJeff Kirsher */ 2192e689cf4aSJeff Kirsher gem_init_phy(gp); 2193e689cf4aSJeff Kirsher 2194e689cf4aSJeff Kirsher return 0; 2195e689cf4aSJeff Kirsher } 2196e689cf4aSJeff Kirsher 2197e689cf4aSJeff Kirsher static void gem_do_stop(struct net_device *dev, int wol) 2198e689cf4aSJeff Kirsher { 2199e689cf4aSJeff Kirsher struct gem *gp = netdev_priv(dev); 2200e689cf4aSJeff Kirsher 2201e689cf4aSJeff Kirsher /* Stop NAPI and stop tx queue */ 2202e689cf4aSJeff Kirsher gem_netif_stop(gp); 2203e689cf4aSJeff Kirsher 2204e689cf4aSJeff Kirsher /* Make sure ints are disabled. We don't care about 2205e689cf4aSJeff Kirsher * synchronizing as NAPI is disabled, thus a stray 2206e689cf4aSJeff Kirsher * interrupt will do nothing bad (our irq handler 2207e689cf4aSJeff Kirsher * just schedules NAPI) 2208e689cf4aSJeff Kirsher */ 2209e689cf4aSJeff Kirsher gem_disable_ints(gp); 2210e689cf4aSJeff Kirsher 2211e689cf4aSJeff Kirsher /* Stop the link timer */ 2212e689cf4aSJeff Kirsher del_timer_sync(&gp->link_timer); 2213e689cf4aSJeff Kirsher 2214e689cf4aSJeff Kirsher /* We cannot cancel the reset task while holding the 2215e689cf4aSJeff Kirsher * rtnl lock, we'd get an A->B / B->A deadlock stituation 2216e689cf4aSJeff Kirsher * if we did. This is not an issue however as the reset 2217e689cf4aSJeff Kirsher * task is synchronized vs. us (rtnl_lock) and will do 2218e689cf4aSJeff Kirsher * nothing if the device is down or suspended. We do 2219e689cf4aSJeff Kirsher * still clear reset_task_pending to avoid a spurrious 2220e689cf4aSJeff Kirsher * reset later on in case we do resume before it gets 2221e689cf4aSJeff Kirsher * scheduled. 2222e689cf4aSJeff Kirsher */ 2223e689cf4aSJeff Kirsher gp->reset_task_pending = 0; 2224e689cf4aSJeff Kirsher 2225e689cf4aSJeff Kirsher /* If we are going to sleep with WOL */ 2226e689cf4aSJeff Kirsher gem_stop_dma(gp); 2227e689cf4aSJeff Kirsher msleep(10); 2228e689cf4aSJeff Kirsher if (!wol) 2229e689cf4aSJeff Kirsher gem_reset(gp); 2230e689cf4aSJeff Kirsher msleep(10); 2231e689cf4aSJeff Kirsher 2232e689cf4aSJeff Kirsher /* Get rid of rings */ 2233e689cf4aSJeff Kirsher gem_clean_rings(gp); 2234e689cf4aSJeff Kirsher 2235e689cf4aSJeff Kirsher /* No irq needed anymore */ 2236e689cf4aSJeff Kirsher free_irq(gp->pdev->irq, (void *) dev); 2237e689cf4aSJeff Kirsher 2238e689cf4aSJeff Kirsher /* Shut the PHY down eventually and setup WOL */ 2239e689cf4aSJeff Kirsher gem_stop_phy(gp, wol); 2240e689cf4aSJeff Kirsher 2241e689cf4aSJeff Kirsher /* Make sure bus master is disabled */ 2242e689cf4aSJeff Kirsher pci_disable_device(gp->pdev); 2243e689cf4aSJeff Kirsher 2244e689cf4aSJeff Kirsher /* Cell not needed neither if no WOL */ 2245e689cf4aSJeff Kirsher if (!wol) 2246e689cf4aSJeff Kirsher gem_put_cell(gp); 2247e689cf4aSJeff Kirsher } 2248e689cf4aSJeff Kirsher 2249e689cf4aSJeff Kirsher static void gem_reset_task(struct work_struct *work) 2250e689cf4aSJeff Kirsher { 2251e689cf4aSJeff Kirsher struct gem *gp = container_of(work, struct gem, reset_task); 2252e689cf4aSJeff Kirsher 2253e689cf4aSJeff Kirsher /* Lock out the network stack (essentially shield ourselves 2254e689cf4aSJeff Kirsher * against a racing open, close, control call, or suspend 2255e689cf4aSJeff Kirsher */ 2256e689cf4aSJeff Kirsher rtnl_lock(); 2257e689cf4aSJeff Kirsher 2258e689cf4aSJeff Kirsher /* Skip the reset task if suspended or closed, or if it's 2259e689cf4aSJeff Kirsher * been cancelled by gem_do_stop (see comment there) 2260e689cf4aSJeff Kirsher */ 2261e689cf4aSJeff Kirsher if (!netif_device_present(gp->dev) || 2262e689cf4aSJeff Kirsher !netif_running(gp->dev) || 2263e689cf4aSJeff Kirsher !gp->reset_task_pending) { 2264e689cf4aSJeff Kirsher rtnl_unlock(); 2265e689cf4aSJeff Kirsher return; 2266e689cf4aSJeff Kirsher } 2267e689cf4aSJeff Kirsher 2268e689cf4aSJeff Kirsher /* Stop the link timer */ 2269e689cf4aSJeff Kirsher del_timer_sync(&gp->link_timer); 2270e689cf4aSJeff Kirsher 2271e689cf4aSJeff Kirsher /* Stop NAPI and tx */ 2272e689cf4aSJeff Kirsher gem_netif_stop(gp); 2273e689cf4aSJeff Kirsher 2274e689cf4aSJeff Kirsher /* Reset the chip & rings */ 2275e689cf4aSJeff Kirsher gem_reinit_chip(gp); 2276e689cf4aSJeff Kirsher if (gp->lstate == link_up) 2277e689cf4aSJeff Kirsher gem_set_link_modes(gp); 2278e689cf4aSJeff Kirsher 2279e689cf4aSJeff Kirsher /* Restart NAPI and Tx */ 2280e689cf4aSJeff Kirsher gem_netif_start(gp); 2281e689cf4aSJeff Kirsher 2282e689cf4aSJeff Kirsher /* We are back ! */ 2283e689cf4aSJeff Kirsher gp->reset_task_pending = 0; 2284e689cf4aSJeff Kirsher 2285e689cf4aSJeff Kirsher /* If the link is not up, restart autoneg, else restart the 2286e689cf4aSJeff Kirsher * polling timer 2287e689cf4aSJeff Kirsher */ 2288e689cf4aSJeff Kirsher if (gp->lstate != link_up) 2289e689cf4aSJeff Kirsher gem_begin_auto_negotiation(gp, NULL); 2290e689cf4aSJeff Kirsher else 2291e689cf4aSJeff Kirsher mod_timer(&gp->link_timer, jiffies + ((12 * HZ) / 10)); 2292e689cf4aSJeff Kirsher 2293e689cf4aSJeff Kirsher rtnl_unlock(); 2294e689cf4aSJeff Kirsher } 2295e689cf4aSJeff Kirsher 2296e689cf4aSJeff Kirsher static int gem_open(struct net_device *dev) 2297e689cf4aSJeff Kirsher { 2298e689cf4aSJeff Kirsher /* We allow open while suspended, we just do nothing, 2299e689cf4aSJeff Kirsher * the chip will be initialized in resume() 2300e689cf4aSJeff Kirsher */ 2301e689cf4aSJeff Kirsher if (netif_device_present(dev)) 2302e689cf4aSJeff Kirsher return gem_do_start(dev); 2303e689cf4aSJeff Kirsher return 0; 2304e689cf4aSJeff Kirsher } 2305e689cf4aSJeff Kirsher 2306e689cf4aSJeff Kirsher static int gem_close(struct net_device *dev) 2307e689cf4aSJeff Kirsher { 2308e689cf4aSJeff Kirsher if (netif_device_present(dev)) 2309e689cf4aSJeff Kirsher gem_do_stop(dev, 0); 2310e689cf4aSJeff Kirsher 2311e689cf4aSJeff Kirsher return 0; 2312e689cf4aSJeff Kirsher } 2313e689cf4aSJeff Kirsher 2314e689cf4aSJeff Kirsher #ifdef CONFIG_PM 2315e689cf4aSJeff Kirsher static int gem_suspend(struct pci_dev *pdev, pm_message_t state) 2316e689cf4aSJeff Kirsher { 2317e689cf4aSJeff Kirsher struct net_device *dev = pci_get_drvdata(pdev); 2318e689cf4aSJeff Kirsher struct gem *gp = netdev_priv(dev); 2319e689cf4aSJeff Kirsher 2320e689cf4aSJeff Kirsher /* Lock the network stack first to avoid racing with open/close, 2321e689cf4aSJeff Kirsher * reset task and setting calls 2322e689cf4aSJeff Kirsher */ 2323e689cf4aSJeff Kirsher rtnl_lock(); 2324e689cf4aSJeff Kirsher 2325e689cf4aSJeff Kirsher /* Not running, mark ourselves non-present, no need for 2326e689cf4aSJeff Kirsher * a lock here 2327e689cf4aSJeff Kirsher */ 2328e689cf4aSJeff Kirsher if (!netif_running(dev)) { 2329e689cf4aSJeff Kirsher netif_device_detach(dev); 2330e689cf4aSJeff Kirsher rtnl_unlock(); 2331e689cf4aSJeff Kirsher return 0; 2332e689cf4aSJeff Kirsher } 2333e689cf4aSJeff Kirsher netdev_info(dev, "suspending, WakeOnLan %s\n", 2334e689cf4aSJeff Kirsher (gp->wake_on_lan && netif_running(dev)) ? 2335e689cf4aSJeff Kirsher "enabled" : "disabled"); 2336e689cf4aSJeff Kirsher 2337e689cf4aSJeff Kirsher /* Tell the network stack we're gone. gem_do_stop() below will 2338e689cf4aSJeff Kirsher * synchronize with TX, stop NAPI etc... 2339e689cf4aSJeff Kirsher */ 2340e689cf4aSJeff Kirsher netif_device_detach(dev); 2341e689cf4aSJeff Kirsher 2342e689cf4aSJeff Kirsher /* Switch off chip, remember WOL setting */ 2343e689cf4aSJeff Kirsher gp->asleep_wol = gp->wake_on_lan; 2344e689cf4aSJeff Kirsher gem_do_stop(dev, gp->asleep_wol); 2345e689cf4aSJeff Kirsher 2346e689cf4aSJeff Kirsher /* Unlock the network stack */ 2347e689cf4aSJeff Kirsher rtnl_unlock(); 2348e689cf4aSJeff Kirsher 2349e689cf4aSJeff Kirsher return 0; 2350e689cf4aSJeff Kirsher } 2351e689cf4aSJeff Kirsher 2352e689cf4aSJeff Kirsher static int gem_resume(struct pci_dev *pdev) 2353e689cf4aSJeff Kirsher { 2354e689cf4aSJeff Kirsher struct net_device *dev = pci_get_drvdata(pdev); 2355e689cf4aSJeff Kirsher struct gem *gp = netdev_priv(dev); 2356e689cf4aSJeff Kirsher 2357e689cf4aSJeff Kirsher /* See locking comment in gem_suspend */ 2358e689cf4aSJeff Kirsher rtnl_lock(); 2359e689cf4aSJeff Kirsher 2360e689cf4aSJeff Kirsher /* Not running, mark ourselves present, no need for 2361e689cf4aSJeff Kirsher * a lock here 2362e689cf4aSJeff Kirsher */ 2363e689cf4aSJeff Kirsher if (!netif_running(dev)) { 2364e689cf4aSJeff Kirsher netif_device_attach(dev); 2365e689cf4aSJeff Kirsher rtnl_unlock(); 2366e689cf4aSJeff Kirsher return 0; 2367e689cf4aSJeff Kirsher } 2368e689cf4aSJeff Kirsher 2369e689cf4aSJeff Kirsher /* Restart chip. If that fails there isn't much we can do, we 2370e689cf4aSJeff Kirsher * leave things stopped. 2371e689cf4aSJeff Kirsher */ 2372e689cf4aSJeff Kirsher gem_do_start(dev); 2373e689cf4aSJeff Kirsher 2374e689cf4aSJeff Kirsher /* If we had WOL enabled, the cell clock was never turned off during 2375e689cf4aSJeff Kirsher * sleep, so we end up beeing unbalanced. Fix that here 2376e689cf4aSJeff Kirsher */ 2377e689cf4aSJeff Kirsher if (gp->asleep_wol) 2378e689cf4aSJeff Kirsher gem_put_cell(gp); 2379e689cf4aSJeff Kirsher 2380e689cf4aSJeff Kirsher /* Unlock the network stack */ 2381e689cf4aSJeff Kirsher rtnl_unlock(); 2382e689cf4aSJeff Kirsher 2383e689cf4aSJeff Kirsher return 0; 2384e689cf4aSJeff Kirsher } 2385e689cf4aSJeff Kirsher #endif /* CONFIG_PM */ 2386e689cf4aSJeff Kirsher 2387e689cf4aSJeff Kirsher static struct net_device_stats *gem_get_stats(struct net_device *dev) 2388e689cf4aSJeff Kirsher { 2389e689cf4aSJeff Kirsher struct gem *gp = netdev_priv(dev); 2390e689cf4aSJeff Kirsher 2391e689cf4aSJeff Kirsher /* I have seen this being called while the PM was in progress, 2392e689cf4aSJeff Kirsher * so we shield against this. Let's also not poke at registers 2393e689cf4aSJeff Kirsher * while the reset task is going on. 2394e689cf4aSJeff Kirsher * 2395e689cf4aSJeff Kirsher * TODO: Move stats collection elsewhere (link timer ?) and 2396e689cf4aSJeff Kirsher * make this a nop to avoid all those synchro issues 2397e689cf4aSJeff Kirsher */ 2398e689cf4aSJeff Kirsher if (!netif_device_present(dev) || !netif_running(dev)) 2399e689cf4aSJeff Kirsher goto bail; 2400e689cf4aSJeff Kirsher 2401e689cf4aSJeff Kirsher /* Better safe than sorry... */ 2402e689cf4aSJeff Kirsher if (WARN_ON(!gp->cell_enabled)) 2403e689cf4aSJeff Kirsher goto bail; 2404e689cf4aSJeff Kirsher 2405e689cf4aSJeff Kirsher dev->stats.rx_crc_errors += readl(gp->regs + MAC_FCSERR); 2406e689cf4aSJeff Kirsher writel(0, gp->regs + MAC_FCSERR); 2407e689cf4aSJeff Kirsher 2408e689cf4aSJeff Kirsher dev->stats.rx_frame_errors += readl(gp->regs + MAC_AERR); 2409e689cf4aSJeff Kirsher writel(0, gp->regs + MAC_AERR); 2410e689cf4aSJeff Kirsher 2411e689cf4aSJeff Kirsher dev->stats.rx_length_errors += readl(gp->regs + MAC_LERR); 2412e689cf4aSJeff Kirsher writel(0, gp->regs + MAC_LERR); 2413e689cf4aSJeff Kirsher 2414e689cf4aSJeff Kirsher dev->stats.tx_aborted_errors += readl(gp->regs + MAC_ECOLL); 2415e689cf4aSJeff Kirsher dev->stats.collisions += 2416e689cf4aSJeff Kirsher (readl(gp->regs + MAC_ECOLL) + readl(gp->regs + MAC_LCOLL)); 2417e689cf4aSJeff Kirsher writel(0, gp->regs + MAC_ECOLL); 2418e689cf4aSJeff Kirsher writel(0, gp->regs + MAC_LCOLL); 2419e689cf4aSJeff Kirsher bail: 2420e689cf4aSJeff Kirsher return &dev->stats; 2421e689cf4aSJeff Kirsher } 2422e689cf4aSJeff Kirsher 2423e689cf4aSJeff Kirsher static int gem_set_mac_address(struct net_device *dev, void *addr) 2424e689cf4aSJeff Kirsher { 2425e689cf4aSJeff Kirsher struct sockaddr *macaddr = (struct sockaddr *) addr; 2426e689cf4aSJeff Kirsher struct gem *gp = netdev_priv(dev); 2427e689cf4aSJeff Kirsher unsigned char *e = &dev->dev_addr[0]; 2428e689cf4aSJeff Kirsher 2429e689cf4aSJeff Kirsher if (!is_valid_ether_addr(macaddr->sa_data)) 2430e689cf4aSJeff Kirsher return -EADDRNOTAVAIL; 2431e689cf4aSJeff Kirsher 2432e689cf4aSJeff Kirsher memcpy(dev->dev_addr, macaddr->sa_data, dev->addr_len); 2433e689cf4aSJeff Kirsher 2434e689cf4aSJeff Kirsher /* We'll just catch it later when the device is up'd or resumed */ 2435e689cf4aSJeff Kirsher if (!netif_running(dev) || !netif_device_present(dev)) 2436e689cf4aSJeff Kirsher return 0; 2437e689cf4aSJeff Kirsher 2438e689cf4aSJeff Kirsher /* Better safe than sorry... */ 2439e689cf4aSJeff Kirsher if (WARN_ON(!gp->cell_enabled)) 2440e689cf4aSJeff Kirsher return 0; 2441e689cf4aSJeff Kirsher 2442e689cf4aSJeff Kirsher writel((e[4] << 8) | e[5], gp->regs + MAC_ADDR0); 2443e689cf4aSJeff Kirsher writel((e[2] << 8) | e[3], gp->regs + MAC_ADDR1); 2444e689cf4aSJeff Kirsher writel((e[0] << 8) | e[1], gp->regs + MAC_ADDR2); 2445e689cf4aSJeff Kirsher 2446e689cf4aSJeff Kirsher return 0; 2447e689cf4aSJeff Kirsher } 2448e689cf4aSJeff Kirsher 2449e689cf4aSJeff Kirsher static void gem_set_multicast(struct net_device *dev) 2450e689cf4aSJeff Kirsher { 2451e689cf4aSJeff Kirsher struct gem *gp = netdev_priv(dev); 2452e689cf4aSJeff Kirsher u32 rxcfg, rxcfg_new; 2453e689cf4aSJeff Kirsher int limit = 10000; 2454e689cf4aSJeff Kirsher 2455e689cf4aSJeff Kirsher if (!netif_running(dev) || !netif_device_present(dev)) 2456e689cf4aSJeff Kirsher return; 2457e689cf4aSJeff Kirsher 2458e689cf4aSJeff Kirsher /* Better safe than sorry... */ 2459e689cf4aSJeff Kirsher if (gp->reset_task_pending || WARN_ON(!gp->cell_enabled)) 2460e689cf4aSJeff Kirsher return; 2461e689cf4aSJeff Kirsher 2462e689cf4aSJeff Kirsher rxcfg = readl(gp->regs + MAC_RXCFG); 2463e689cf4aSJeff Kirsher rxcfg_new = gem_setup_multicast(gp); 2464e689cf4aSJeff Kirsher #ifdef STRIP_FCS 2465e689cf4aSJeff Kirsher rxcfg_new |= MAC_RXCFG_SFCS; 2466e689cf4aSJeff Kirsher #endif 2467e689cf4aSJeff Kirsher gp->mac_rx_cfg = rxcfg_new; 2468e689cf4aSJeff Kirsher 2469e689cf4aSJeff Kirsher writel(rxcfg & ~MAC_RXCFG_ENAB, gp->regs + MAC_RXCFG); 2470e689cf4aSJeff Kirsher while (readl(gp->regs + MAC_RXCFG) & MAC_RXCFG_ENAB) { 2471e689cf4aSJeff Kirsher if (!limit--) 2472e689cf4aSJeff Kirsher break; 2473e689cf4aSJeff Kirsher udelay(10); 2474e689cf4aSJeff Kirsher } 2475e689cf4aSJeff Kirsher 2476e689cf4aSJeff Kirsher rxcfg &= ~(MAC_RXCFG_PROM | MAC_RXCFG_HFE); 2477e689cf4aSJeff Kirsher rxcfg |= rxcfg_new; 2478e689cf4aSJeff Kirsher 2479e689cf4aSJeff Kirsher writel(rxcfg, gp->regs + MAC_RXCFG); 2480e689cf4aSJeff Kirsher } 2481e689cf4aSJeff Kirsher 2482e689cf4aSJeff Kirsher /* Jumbo-grams don't seem to work :-( */ 2483e689cf4aSJeff Kirsher #define GEM_MIN_MTU 68 2484e689cf4aSJeff Kirsher #if 1 2485e689cf4aSJeff Kirsher #define GEM_MAX_MTU 1500 2486e689cf4aSJeff Kirsher #else 2487e689cf4aSJeff Kirsher #define GEM_MAX_MTU 9000 2488e689cf4aSJeff Kirsher #endif 2489e689cf4aSJeff Kirsher 2490e689cf4aSJeff Kirsher static int gem_change_mtu(struct net_device *dev, int new_mtu) 2491e689cf4aSJeff Kirsher { 2492e689cf4aSJeff Kirsher struct gem *gp = netdev_priv(dev); 2493e689cf4aSJeff Kirsher 2494e689cf4aSJeff Kirsher if (new_mtu < GEM_MIN_MTU || new_mtu > GEM_MAX_MTU) 2495e689cf4aSJeff Kirsher return -EINVAL; 2496e689cf4aSJeff Kirsher 2497e689cf4aSJeff Kirsher dev->mtu = new_mtu; 2498e689cf4aSJeff Kirsher 2499e689cf4aSJeff Kirsher /* We'll just catch it later when the device is up'd or resumed */ 2500e689cf4aSJeff Kirsher if (!netif_running(dev) || !netif_device_present(dev)) 2501e689cf4aSJeff Kirsher return 0; 2502e689cf4aSJeff Kirsher 2503e689cf4aSJeff Kirsher /* Better safe than sorry... */ 2504e689cf4aSJeff Kirsher if (WARN_ON(!gp->cell_enabled)) 2505e689cf4aSJeff Kirsher return 0; 2506e689cf4aSJeff Kirsher 2507e689cf4aSJeff Kirsher gem_netif_stop(gp); 2508e689cf4aSJeff Kirsher gem_reinit_chip(gp); 2509e689cf4aSJeff Kirsher if (gp->lstate == link_up) 2510e689cf4aSJeff Kirsher gem_set_link_modes(gp); 2511e689cf4aSJeff Kirsher gem_netif_start(gp); 2512e689cf4aSJeff Kirsher 2513e689cf4aSJeff Kirsher return 0; 2514e689cf4aSJeff Kirsher } 2515e689cf4aSJeff Kirsher 2516e689cf4aSJeff Kirsher static void gem_get_drvinfo(struct net_device *dev, struct ethtool_drvinfo *info) 2517e689cf4aSJeff Kirsher { 2518e689cf4aSJeff Kirsher struct gem *gp = netdev_priv(dev); 2519e689cf4aSJeff Kirsher 2520e689cf4aSJeff Kirsher strcpy(info->driver, DRV_NAME); 2521e689cf4aSJeff Kirsher strcpy(info->version, DRV_VERSION); 2522e689cf4aSJeff Kirsher strcpy(info->bus_info, pci_name(gp->pdev)); 2523e689cf4aSJeff Kirsher } 2524e689cf4aSJeff Kirsher 2525e689cf4aSJeff Kirsher static int gem_get_settings(struct net_device *dev, struct ethtool_cmd *cmd) 2526e689cf4aSJeff Kirsher { 2527e689cf4aSJeff Kirsher struct gem *gp = netdev_priv(dev); 2528e689cf4aSJeff Kirsher 2529e689cf4aSJeff Kirsher if (gp->phy_type == phy_mii_mdio0 || 2530e689cf4aSJeff Kirsher gp->phy_type == phy_mii_mdio1) { 2531e689cf4aSJeff Kirsher if (gp->phy_mii.def) 2532e689cf4aSJeff Kirsher cmd->supported = gp->phy_mii.def->features; 2533e689cf4aSJeff Kirsher else 2534e689cf4aSJeff Kirsher cmd->supported = (SUPPORTED_10baseT_Half | 2535e689cf4aSJeff Kirsher SUPPORTED_10baseT_Full); 2536e689cf4aSJeff Kirsher 2537e689cf4aSJeff Kirsher /* XXX hardcoded stuff for now */ 2538e689cf4aSJeff Kirsher cmd->port = PORT_MII; 2539e689cf4aSJeff Kirsher cmd->transceiver = XCVR_EXTERNAL; 2540e689cf4aSJeff Kirsher cmd->phy_address = 0; /* XXX fixed PHYAD */ 2541e689cf4aSJeff Kirsher 2542e689cf4aSJeff Kirsher /* Return current PHY settings */ 2543e689cf4aSJeff Kirsher cmd->autoneg = gp->want_autoneg; 2544e689cf4aSJeff Kirsher ethtool_cmd_speed_set(cmd, gp->phy_mii.speed); 2545e689cf4aSJeff Kirsher cmd->duplex = gp->phy_mii.duplex; 2546e689cf4aSJeff Kirsher cmd->advertising = gp->phy_mii.advertising; 2547e689cf4aSJeff Kirsher 2548e689cf4aSJeff Kirsher /* If we started with a forced mode, we don't have a default 2549e689cf4aSJeff Kirsher * advertise set, we need to return something sensible so 2550e689cf4aSJeff Kirsher * userland can re-enable autoneg properly. 2551e689cf4aSJeff Kirsher */ 2552e689cf4aSJeff Kirsher if (cmd->advertising == 0) 2553e689cf4aSJeff Kirsher cmd->advertising = cmd->supported; 2554e689cf4aSJeff Kirsher } else { // XXX PCS ? 2555e689cf4aSJeff Kirsher cmd->supported = 2556e689cf4aSJeff Kirsher (SUPPORTED_10baseT_Half | SUPPORTED_10baseT_Full | 2557e689cf4aSJeff Kirsher SUPPORTED_100baseT_Half | SUPPORTED_100baseT_Full | 2558e689cf4aSJeff Kirsher SUPPORTED_Autoneg); 2559e689cf4aSJeff Kirsher cmd->advertising = cmd->supported; 2560e689cf4aSJeff Kirsher ethtool_cmd_speed_set(cmd, 0); 2561e689cf4aSJeff Kirsher cmd->duplex = cmd->port = cmd->phy_address = 2562e689cf4aSJeff Kirsher cmd->transceiver = cmd->autoneg = 0; 2563e689cf4aSJeff Kirsher 2564e689cf4aSJeff Kirsher /* serdes means usually a Fibre connector, with most fixed */ 2565e689cf4aSJeff Kirsher if (gp->phy_type == phy_serdes) { 2566e689cf4aSJeff Kirsher cmd->port = PORT_FIBRE; 2567e689cf4aSJeff Kirsher cmd->supported = (SUPPORTED_1000baseT_Half | 2568e689cf4aSJeff Kirsher SUPPORTED_1000baseT_Full | 2569e689cf4aSJeff Kirsher SUPPORTED_FIBRE | SUPPORTED_Autoneg | 2570e689cf4aSJeff Kirsher SUPPORTED_Pause | SUPPORTED_Asym_Pause); 2571e689cf4aSJeff Kirsher cmd->advertising = cmd->supported; 2572e689cf4aSJeff Kirsher cmd->transceiver = XCVR_INTERNAL; 2573e689cf4aSJeff Kirsher if (gp->lstate == link_up) 2574e689cf4aSJeff Kirsher ethtool_cmd_speed_set(cmd, SPEED_1000); 2575e689cf4aSJeff Kirsher cmd->duplex = DUPLEX_FULL; 2576e689cf4aSJeff Kirsher cmd->autoneg = 1; 2577e689cf4aSJeff Kirsher } 2578e689cf4aSJeff Kirsher } 2579e689cf4aSJeff Kirsher cmd->maxtxpkt = cmd->maxrxpkt = 0; 2580e689cf4aSJeff Kirsher 2581e689cf4aSJeff Kirsher return 0; 2582e689cf4aSJeff Kirsher } 2583e689cf4aSJeff Kirsher 2584e689cf4aSJeff Kirsher static int gem_set_settings(struct net_device *dev, struct ethtool_cmd *cmd) 2585e689cf4aSJeff Kirsher { 2586e689cf4aSJeff Kirsher struct gem *gp = netdev_priv(dev); 2587e689cf4aSJeff Kirsher u32 speed = ethtool_cmd_speed(cmd); 2588e689cf4aSJeff Kirsher 2589e689cf4aSJeff Kirsher /* Verify the settings we care about. */ 2590e689cf4aSJeff Kirsher if (cmd->autoneg != AUTONEG_ENABLE && 2591e689cf4aSJeff Kirsher cmd->autoneg != AUTONEG_DISABLE) 2592e689cf4aSJeff Kirsher return -EINVAL; 2593e689cf4aSJeff Kirsher 2594e689cf4aSJeff Kirsher if (cmd->autoneg == AUTONEG_ENABLE && 2595e689cf4aSJeff Kirsher cmd->advertising == 0) 2596e689cf4aSJeff Kirsher return -EINVAL; 2597e689cf4aSJeff Kirsher 2598e689cf4aSJeff Kirsher if (cmd->autoneg == AUTONEG_DISABLE && 2599e689cf4aSJeff Kirsher ((speed != SPEED_1000 && 2600e689cf4aSJeff Kirsher speed != SPEED_100 && 2601e689cf4aSJeff Kirsher speed != SPEED_10) || 2602e689cf4aSJeff Kirsher (cmd->duplex != DUPLEX_HALF && 2603e689cf4aSJeff Kirsher cmd->duplex != DUPLEX_FULL))) 2604e689cf4aSJeff Kirsher return -EINVAL; 2605e689cf4aSJeff Kirsher 2606e689cf4aSJeff Kirsher /* Apply settings and restart link process. */ 2607e689cf4aSJeff Kirsher if (netif_device_present(gp->dev)) { 2608e689cf4aSJeff Kirsher del_timer_sync(&gp->link_timer); 2609e689cf4aSJeff Kirsher gem_begin_auto_negotiation(gp, cmd); 2610e689cf4aSJeff Kirsher } 2611e689cf4aSJeff Kirsher 2612e689cf4aSJeff Kirsher return 0; 2613e689cf4aSJeff Kirsher } 2614e689cf4aSJeff Kirsher 2615e689cf4aSJeff Kirsher static int gem_nway_reset(struct net_device *dev) 2616e689cf4aSJeff Kirsher { 2617e689cf4aSJeff Kirsher struct gem *gp = netdev_priv(dev); 2618e689cf4aSJeff Kirsher 2619e689cf4aSJeff Kirsher if (!gp->want_autoneg) 2620e689cf4aSJeff Kirsher return -EINVAL; 2621e689cf4aSJeff Kirsher 2622e689cf4aSJeff Kirsher /* Restart link process */ 2623e689cf4aSJeff Kirsher if (netif_device_present(gp->dev)) { 2624e689cf4aSJeff Kirsher del_timer_sync(&gp->link_timer); 2625e689cf4aSJeff Kirsher gem_begin_auto_negotiation(gp, NULL); 2626e689cf4aSJeff Kirsher } 2627e689cf4aSJeff Kirsher 2628e689cf4aSJeff Kirsher return 0; 2629e689cf4aSJeff Kirsher } 2630e689cf4aSJeff Kirsher 2631e689cf4aSJeff Kirsher static u32 gem_get_msglevel(struct net_device *dev) 2632e689cf4aSJeff Kirsher { 2633e689cf4aSJeff Kirsher struct gem *gp = netdev_priv(dev); 2634e689cf4aSJeff Kirsher return gp->msg_enable; 2635e689cf4aSJeff Kirsher } 2636e689cf4aSJeff Kirsher 2637e689cf4aSJeff Kirsher static void gem_set_msglevel(struct net_device *dev, u32 value) 2638e689cf4aSJeff Kirsher { 2639e689cf4aSJeff Kirsher struct gem *gp = netdev_priv(dev); 2640e689cf4aSJeff Kirsher gp->msg_enable = value; 2641e689cf4aSJeff Kirsher } 2642e689cf4aSJeff Kirsher 2643e689cf4aSJeff Kirsher 2644e689cf4aSJeff Kirsher /* Add more when I understand how to program the chip */ 2645e689cf4aSJeff Kirsher /* like WAKE_UCAST | WAKE_MCAST | WAKE_BCAST */ 2646e689cf4aSJeff Kirsher 2647e689cf4aSJeff Kirsher #define WOL_SUPPORTED_MASK (WAKE_MAGIC) 2648e689cf4aSJeff Kirsher 2649e689cf4aSJeff Kirsher static void gem_get_wol(struct net_device *dev, struct ethtool_wolinfo *wol) 2650e689cf4aSJeff Kirsher { 2651e689cf4aSJeff Kirsher struct gem *gp = netdev_priv(dev); 2652e689cf4aSJeff Kirsher 2653e689cf4aSJeff Kirsher /* Add more when I understand how to program the chip */ 2654e689cf4aSJeff Kirsher if (gp->has_wol) { 2655e689cf4aSJeff Kirsher wol->supported = WOL_SUPPORTED_MASK; 2656e689cf4aSJeff Kirsher wol->wolopts = gp->wake_on_lan; 2657e689cf4aSJeff Kirsher } else { 2658e689cf4aSJeff Kirsher wol->supported = 0; 2659e689cf4aSJeff Kirsher wol->wolopts = 0; 2660e689cf4aSJeff Kirsher } 2661e689cf4aSJeff Kirsher } 2662e689cf4aSJeff Kirsher 2663e689cf4aSJeff Kirsher static int gem_set_wol(struct net_device *dev, struct ethtool_wolinfo *wol) 2664e689cf4aSJeff Kirsher { 2665e689cf4aSJeff Kirsher struct gem *gp = netdev_priv(dev); 2666e689cf4aSJeff Kirsher 2667e689cf4aSJeff Kirsher if (!gp->has_wol) 2668e689cf4aSJeff Kirsher return -EOPNOTSUPP; 2669e689cf4aSJeff Kirsher gp->wake_on_lan = wol->wolopts & WOL_SUPPORTED_MASK; 2670e689cf4aSJeff Kirsher return 0; 2671e689cf4aSJeff Kirsher } 2672e689cf4aSJeff Kirsher 2673e689cf4aSJeff Kirsher static const struct ethtool_ops gem_ethtool_ops = { 2674e689cf4aSJeff Kirsher .get_drvinfo = gem_get_drvinfo, 2675e689cf4aSJeff Kirsher .get_link = ethtool_op_get_link, 2676e689cf4aSJeff Kirsher .get_settings = gem_get_settings, 2677e689cf4aSJeff Kirsher .set_settings = gem_set_settings, 2678e689cf4aSJeff Kirsher .nway_reset = gem_nway_reset, 2679e689cf4aSJeff Kirsher .get_msglevel = gem_get_msglevel, 2680e689cf4aSJeff Kirsher .set_msglevel = gem_set_msglevel, 2681e689cf4aSJeff Kirsher .get_wol = gem_get_wol, 2682e689cf4aSJeff Kirsher .set_wol = gem_set_wol, 2683e689cf4aSJeff Kirsher }; 2684e689cf4aSJeff Kirsher 2685e689cf4aSJeff Kirsher static int gem_ioctl(struct net_device *dev, struct ifreq *ifr, int cmd) 2686e689cf4aSJeff Kirsher { 2687e689cf4aSJeff Kirsher struct gem *gp = netdev_priv(dev); 2688e689cf4aSJeff Kirsher struct mii_ioctl_data *data = if_mii(ifr); 2689e689cf4aSJeff Kirsher int rc = -EOPNOTSUPP; 2690e689cf4aSJeff Kirsher 2691e689cf4aSJeff Kirsher /* For SIOCGMIIREG and SIOCSMIIREG the core checks for us that 2692e689cf4aSJeff Kirsher * netif_device_present() is true and holds rtnl_lock for us 2693e689cf4aSJeff Kirsher * so we have nothing to worry about 2694e689cf4aSJeff Kirsher */ 2695e689cf4aSJeff Kirsher 2696e689cf4aSJeff Kirsher switch (cmd) { 2697e689cf4aSJeff Kirsher case SIOCGMIIPHY: /* Get address of MII PHY in use. */ 2698e689cf4aSJeff Kirsher data->phy_id = gp->mii_phy_addr; 2699e689cf4aSJeff Kirsher /* Fallthrough... */ 2700e689cf4aSJeff Kirsher 2701e689cf4aSJeff Kirsher case SIOCGMIIREG: /* Read MII PHY register. */ 2702e689cf4aSJeff Kirsher data->val_out = __phy_read(gp, data->phy_id & 0x1f, 2703e689cf4aSJeff Kirsher data->reg_num & 0x1f); 2704e689cf4aSJeff Kirsher rc = 0; 2705e689cf4aSJeff Kirsher break; 2706e689cf4aSJeff Kirsher 2707e689cf4aSJeff Kirsher case SIOCSMIIREG: /* Write MII PHY register. */ 2708e689cf4aSJeff Kirsher __phy_write(gp, data->phy_id & 0x1f, data->reg_num & 0x1f, 2709e689cf4aSJeff Kirsher data->val_in); 2710e689cf4aSJeff Kirsher rc = 0; 2711e689cf4aSJeff Kirsher break; 2712e689cf4aSJeff Kirsher } 2713e689cf4aSJeff Kirsher return rc; 2714e689cf4aSJeff Kirsher } 2715e689cf4aSJeff Kirsher 2716e689cf4aSJeff Kirsher #if (!defined(CONFIG_SPARC) && !defined(CONFIG_PPC_PMAC)) 2717e689cf4aSJeff Kirsher /* Fetch MAC address from vital product data of PCI ROM. */ 2718e689cf4aSJeff Kirsher static int find_eth_addr_in_vpd(void __iomem *rom_base, int len, unsigned char *dev_addr) 2719e689cf4aSJeff Kirsher { 2720e689cf4aSJeff Kirsher int this_offset; 2721e689cf4aSJeff Kirsher 2722e689cf4aSJeff Kirsher for (this_offset = 0x20; this_offset < len; this_offset++) { 2723e689cf4aSJeff Kirsher void __iomem *p = rom_base + this_offset; 2724e689cf4aSJeff Kirsher int i; 2725e689cf4aSJeff Kirsher 2726e689cf4aSJeff Kirsher if (readb(p + 0) != 0x90 || 2727e689cf4aSJeff Kirsher readb(p + 1) != 0x00 || 2728e689cf4aSJeff Kirsher readb(p + 2) != 0x09 || 2729e689cf4aSJeff Kirsher readb(p + 3) != 0x4e || 2730e689cf4aSJeff Kirsher readb(p + 4) != 0x41 || 2731e689cf4aSJeff Kirsher readb(p + 5) != 0x06) 2732e689cf4aSJeff Kirsher continue; 2733e689cf4aSJeff Kirsher 2734e689cf4aSJeff Kirsher this_offset += 6; 2735e689cf4aSJeff Kirsher p += 6; 2736e689cf4aSJeff Kirsher 2737e689cf4aSJeff Kirsher for (i = 0; i < 6; i++) 2738e689cf4aSJeff Kirsher dev_addr[i] = readb(p + i); 2739e689cf4aSJeff Kirsher return 1; 2740e689cf4aSJeff Kirsher } 2741e689cf4aSJeff Kirsher return 0; 2742e689cf4aSJeff Kirsher } 2743e689cf4aSJeff Kirsher 2744e689cf4aSJeff Kirsher static void get_gem_mac_nonobp(struct pci_dev *pdev, unsigned char *dev_addr) 2745e689cf4aSJeff Kirsher { 2746e689cf4aSJeff Kirsher size_t size; 2747e689cf4aSJeff Kirsher void __iomem *p = pci_map_rom(pdev, &size); 2748e689cf4aSJeff Kirsher 2749e689cf4aSJeff Kirsher if (p) { 2750e689cf4aSJeff Kirsher int found; 2751e689cf4aSJeff Kirsher 2752e689cf4aSJeff Kirsher found = readb(p) == 0x55 && 2753e689cf4aSJeff Kirsher readb(p + 1) == 0xaa && 2754e689cf4aSJeff Kirsher find_eth_addr_in_vpd(p, (64 * 1024), dev_addr); 2755e689cf4aSJeff Kirsher pci_unmap_rom(pdev, p); 2756e689cf4aSJeff Kirsher if (found) 2757e689cf4aSJeff Kirsher return; 2758e689cf4aSJeff Kirsher } 2759e689cf4aSJeff Kirsher 2760e689cf4aSJeff Kirsher /* Sun MAC prefix then 3 random bytes. */ 2761e689cf4aSJeff Kirsher dev_addr[0] = 0x08; 2762e689cf4aSJeff Kirsher dev_addr[1] = 0x00; 2763e689cf4aSJeff Kirsher dev_addr[2] = 0x20; 2764e689cf4aSJeff Kirsher get_random_bytes(dev_addr + 3, 3); 2765e689cf4aSJeff Kirsher } 2766e689cf4aSJeff Kirsher #endif /* not Sparc and not PPC */ 2767e689cf4aSJeff Kirsher 2768e689cf4aSJeff Kirsher static int __devinit gem_get_device_address(struct gem *gp) 2769e689cf4aSJeff Kirsher { 2770e689cf4aSJeff Kirsher #if defined(CONFIG_SPARC) || defined(CONFIG_PPC_PMAC) 2771e689cf4aSJeff Kirsher struct net_device *dev = gp->dev; 2772e689cf4aSJeff Kirsher const unsigned char *addr; 2773e689cf4aSJeff Kirsher 2774e689cf4aSJeff Kirsher addr = of_get_property(gp->of_node, "local-mac-address", NULL); 2775e689cf4aSJeff Kirsher if (addr == NULL) { 2776e689cf4aSJeff Kirsher #ifdef CONFIG_SPARC 2777e689cf4aSJeff Kirsher addr = idprom->id_ethaddr; 2778e689cf4aSJeff Kirsher #else 2779e689cf4aSJeff Kirsher printk("\n"); 2780e689cf4aSJeff Kirsher pr_err("%s: can't get mac-address\n", dev->name); 2781e689cf4aSJeff Kirsher return -1; 2782e689cf4aSJeff Kirsher #endif 2783e689cf4aSJeff Kirsher } 2784e689cf4aSJeff Kirsher memcpy(dev->dev_addr, addr, 6); 2785e689cf4aSJeff Kirsher #else 2786e689cf4aSJeff Kirsher get_gem_mac_nonobp(gp->pdev, gp->dev->dev_addr); 2787e689cf4aSJeff Kirsher #endif 2788e689cf4aSJeff Kirsher return 0; 2789e689cf4aSJeff Kirsher } 2790e689cf4aSJeff Kirsher 2791e689cf4aSJeff Kirsher static void gem_remove_one(struct pci_dev *pdev) 2792e689cf4aSJeff Kirsher { 2793e689cf4aSJeff Kirsher struct net_device *dev = pci_get_drvdata(pdev); 2794e689cf4aSJeff Kirsher 2795e689cf4aSJeff Kirsher if (dev) { 2796e689cf4aSJeff Kirsher struct gem *gp = netdev_priv(dev); 2797e689cf4aSJeff Kirsher 2798e689cf4aSJeff Kirsher unregister_netdev(dev); 2799e689cf4aSJeff Kirsher 2800e689cf4aSJeff Kirsher /* Ensure reset task is truely gone */ 2801e689cf4aSJeff Kirsher cancel_work_sync(&gp->reset_task); 2802e689cf4aSJeff Kirsher 2803e689cf4aSJeff Kirsher /* Free resources */ 2804e689cf4aSJeff Kirsher pci_free_consistent(pdev, 2805e689cf4aSJeff Kirsher sizeof(struct gem_init_block), 2806e689cf4aSJeff Kirsher gp->init_block, 2807e689cf4aSJeff Kirsher gp->gblock_dvma); 2808e689cf4aSJeff Kirsher iounmap(gp->regs); 2809e689cf4aSJeff Kirsher pci_release_regions(pdev); 2810e689cf4aSJeff Kirsher free_netdev(dev); 2811e689cf4aSJeff Kirsher 2812e689cf4aSJeff Kirsher pci_set_drvdata(pdev, NULL); 2813e689cf4aSJeff Kirsher } 2814e689cf4aSJeff Kirsher } 2815e689cf4aSJeff Kirsher 2816e689cf4aSJeff Kirsher static const struct net_device_ops gem_netdev_ops = { 2817e689cf4aSJeff Kirsher .ndo_open = gem_open, 2818e689cf4aSJeff Kirsher .ndo_stop = gem_close, 2819e689cf4aSJeff Kirsher .ndo_start_xmit = gem_start_xmit, 2820e689cf4aSJeff Kirsher .ndo_get_stats = gem_get_stats, 2821afc4b13dSJiri Pirko .ndo_set_rx_mode = gem_set_multicast, 2822e689cf4aSJeff Kirsher .ndo_do_ioctl = gem_ioctl, 2823e689cf4aSJeff Kirsher .ndo_tx_timeout = gem_tx_timeout, 2824e689cf4aSJeff Kirsher .ndo_change_mtu = gem_change_mtu, 2825e689cf4aSJeff Kirsher .ndo_validate_addr = eth_validate_addr, 2826e689cf4aSJeff Kirsher .ndo_set_mac_address = gem_set_mac_address, 2827e689cf4aSJeff Kirsher #ifdef CONFIG_NET_POLL_CONTROLLER 2828e689cf4aSJeff Kirsher .ndo_poll_controller = gem_poll_controller, 2829e689cf4aSJeff Kirsher #endif 2830e689cf4aSJeff Kirsher }; 2831e689cf4aSJeff Kirsher 2832e689cf4aSJeff Kirsher static int __devinit gem_init_one(struct pci_dev *pdev, 2833e689cf4aSJeff Kirsher const struct pci_device_id *ent) 2834e689cf4aSJeff Kirsher { 2835e689cf4aSJeff Kirsher unsigned long gemreg_base, gemreg_len; 2836e689cf4aSJeff Kirsher struct net_device *dev; 2837e689cf4aSJeff Kirsher struct gem *gp; 2838e689cf4aSJeff Kirsher int err, pci_using_dac; 2839e689cf4aSJeff Kirsher 2840e689cf4aSJeff Kirsher printk_once(KERN_INFO "%s", version); 2841e689cf4aSJeff Kirsher 2842e689cf4aSJeff Kirsher /* Apple gmac note: during probe, the chip is powered up by 2843e689cf4aSJeff Kirsher * the arch code to allow the code below to work (and to let 2844e689cf4aSJeff Kirsher * the chip be probed on the config space. It won't stay powered 2845e689cf4aSJeff Kirsher * up until the interface is brought up however, so we can't rely 2846e689cf4aSJeff Kirsher * on register configuration done at this point. 2847e689cf4aSJeff Kirsher */ 2848e689cf4aSJeff Kirsher err = pci_enable_device(pdev); 2849e689cf4aSJeff Kirsher if (err) { 2850e689cf4aSJeff Kirsher pr_err("Cannot enable MMIO operation, aborting\n"); 2851e689cf4aSJeff Kirsher return err; 2852e689cf4aSJeff Kirsher } 2853e689cf4aSJeff Kirsher pci_set_master(pdev); 2854e689cf4aSJeff Kirsher 2855e689cf4aSJeff Kirsher /* Configure DMA attributes. */ 2856e689cf4aSJeff Kirsher 2857e689cf4aSJeff Kirsher /* All of the GEM documentation states that 64-bit DMA addressing 2858e689cf4aSJeff Kirsher * is fully supported and should work just fine. However the 2859e689cf4aSJeff Kirsher * front end for RIO based GEMs is different and only supports 2860e689cf4aSJeff Kirsher * 32-bit addressing. 2861e689cf4aSJeff Kirsher * 2862e689cf4aSJeff Kirsher * For now we assume the various PPC GEMs are 32-bit only as well. 2863e689cf4aSJeff Kirsher */ 2864e689cf4aSJeff Kirsher if (pdev->vendor == PCI_VENDOR_ID_SUN && 2865e689cf4aSJeff Kirsher pdev->device == PCI_DEVICE_ID_SUN_GEM && 2866e689cf4aSJeff Kirsher !pci_set_dma_mask(pdev, DMA_BIT_MASK(64))) { 2867e689cf4aSJeff Kirsher pci_using_dac = 1; 2868e689cf4aSJeff Kirsher } else { 2869e689cf4aSJeff Kirsher err = pci_set_dma_mask(pdev, DMA_BIT_MASK(32)); 2870e689cf4aSJeff Kirsher if (err) { 2871e689cf4aSJeff Kirsher pr_err("No usable DMA configuration, aborting\n"); 2872e689cf4aSJeff Kirsher goto err_disable_device; 2873e689cf4aSJeff Kirsher } 2874e689cf4aSJeff Kirsher pci_using_dac = 0; 2875e689cf4aSJeff Kirsher } 2876e689cf4aSJeff Kirsher 2877e689cf4aSJeff Kirsher gemreg_base = pci_resource_start(pdev, 0); 2878e689cf4aSJeff Kirsher gemreg_len = pci_resource_len(pdev, 0); 2879e689cf4aSJeff Kirsher 2880e689cf4aSJeff Kirsher if ((pci_resource_flags(pdev, 0) & IORESOURCE_IO) != 0) { 2881e689cf4aSJeff Kirsher pr_err("Cannot find proper PCI device base address, aborting\n"); 2882e689cf4aSJeff Kirsher err = -ENODEV; 2883e689cf4aSJeff Kirsher goto err_disable_device; 2884e689cf4aSJeff Kirsher } 2885e689cf4aSJeff Kirsher 2886e689cf4aSJeff Kirsher dev = alloc_etherdev(sizeof(*gp)); 2887e689cf4aSJeff Kirsher if (!dev) { 2888e689cf4aSJeff Kirsher pr_err("Etherdev alloc failed, aborting\n"); 2889e689cf4aSJeff Kirsher err = -ENOMEM; 2890e689cf4aSJeff Kirsher goto err_disable_device; 2891e689cf4aSJeff Kirsher } 2892e689cf4aSJeff Kirsher SET_NETDEV_DEV(dev, &pdev->dev); 2893e689cf4aSJeff Kirsher 2894e689cf4aSJeff Kirsher gp = netdev_priv(dev); 2895e689cf4aSJeff Kirsher 2896e689cf4aSJeff Kirsher err = pci_request_regions(pdev, DRV_NAME); 2897e689cf4aSJeff Kirsher if (err) { 2898e689cf4aSJeff Kirsher pr_err("Cannot obtain PCI resources, aborting\n"); 2899e689cf4aSJeff Kirsher goto err_out_free_netdev; 2900e689cf4aSJeff Kirsher } 2901e689cf4aSJeff Kirsher 2902e689cf4aSJeff Kirsher gp->pdev = pdev; 2903e689cf4aSJeff Kirsher dev->base_addr = (long) pdev; 2904e689cf4aSJeff Kirsher gp->dev = dev; 2905e689cf4aSJeff Kirsher 2906e689cf4aSJeff Kirsher gp->msg_enable = DEFAULT_MSG; 2907e689cf4aSJeff Kirsher 2908e689cf4aSJeff Kirsher init_timer(&gp->link_timer); 2909e689cf4aSJeff Kirsher gp->link_timer.function = gem_link_timer; 2910e689cf4aSJeff Kirsher gp->link_timer.data = (unsigned long) gp; 2911e689cf4aSJeff Kirsher 2912e689cf4aSJeff Kirsher INIT_WORK(&gp->reset_task, gem_reset_task); 2913e689cf4aSJeff Kirsher 2914e689cf4aSJeff Kirsher gp->lstate = link_down; 2915e689cf4aSJeff Kirsher gp->timer_ticks = 0; 2916e689cf4aSJeff Kirsher netif_carrier_off(dev); 2917e689cf4aSJeff Kirsher 2918e689cf4aSJeff Kirsher gp->regs = ioremap(gemreg_base, gemreg_len); 2919e689cf4aSJeff Kirsher if (!gp->regs) { 2920e689cf4aSJeff Kirsher pr_err("Cannot map device registers, aborting\n"); 2921e689cf4aSJeff Kirsher err = -EIO; 2922e689cf4aSJeff Kirsher goto err_out_free_res; 2923e689cf4aSJeff Kirsher } 2924e689cf4aSJeff Kirsher 2925e689cf4aSJeff Kirsher /* On Apple, we want a reference to the Open Firmware device-tree 2926e689cf4aSJeff Kirsher * node. We use it for clock control. 2927e689cf4aSJeff Kirsher */ 2928e689cf4aSJeff Kirsher #if defined(CONFIG_PPC_PMAC) || defined(CONFIG_SPARC) 2929e689cf4aSJeff Kirsher gp->of_node = pci_device_to_OF_node(pdev); 2930e689cf4aSJeff Kirsher #endif 2931e689cf4aSJeff Kirsher 2932e689cf4aSJeff Kirsher /* Only Apple version supports WOL afaik */ 2933e689cf4aSJeff Kirsher if (pdev->vendor == PCI_VENDOR_ID_APPLE) 2934e689cf4aSJeff Kirsher gp->has_wol = 1; 2935e689cf4aSJeff Kirsher 2936e689cf4aSJeff Kirsher /* Make sure cell is enabled */ 2937e689cf4aSJeff Kirsher gem_get_cell(gp); 2938e689cf4aSJeff Kirsher 2939e689cf4aSJeff Kirsher /* Make sure everything is stopped and in init state */ 2940e689cf4aSJeff Kirsher gem_reset(gp); 2941e689cf4aSJeff Kirsher 2942e689cf4aSJeff Kirsher /* Fill up the mii_phy structure (even if we won't use it) */ 2943e689cf4aSJeff Kirsher gp->phy_mii.dev = dev; 2944e689cf4aSJeff Kirsher gp->phy_mii.mdio_read = _phy_read; 2945e689cf4aSJeff Kirsher gp->phy_mii.mdio_write = _phy_write; 2946e689cf4aSJeff Kirsher #ifdef CONFIG_PPC_PMAC 2947e689cf4aSJeff Kirsher gp->phy_mii.platform_data = gp->of_node; 2948e689cf4aSJeff Kirsher #endif 2949e689cf4aSJeff Kirsher /* By default, we start with autoneg */ 2950e689cf4aSJeff Kirsher gp->want_autoneg = 1; 2951e689cf4aSJeff Kirsher 2952e689cf4aSJeff Kirsher /* Check fifo sizes, PHY type, etc... */ 2953e689cf4aSJeff Kirsher if (gem_check_invariants(gp)) { 2954e689cf4aSJeff Kirsher err = -ENODEV; 2955e689cf4aSJeff Kirsher goto err_out_iounmap; 2956e689cf4aSJeff Kirsher } 2957e689cf4aSJeff Kirsher 2958e689cf4aSJeff Kirsher /* It is guaranteed that the returned buffer will be at least 2959e689cf4aSJeff Kirsher * PAGE_SIZE aligned. 2960e689cf4aSJeff Kirsher */ 2961e689cf4aSJeff Kirsher gp->init_block = (struct gem_init_block *) 2962e689cf4aSJeff Kirsher pci_alloc_consistent(pdev, sizeof(struct gem_init_block), 2963e689cf4aSJeff Kirsher &gp->gblock_dvma); 2964e689cf4aSJeff Kirsher if (!gp->init_block) { 2965e689cf4aSJeff Kirsher pr_err("Cannot allocate init block, aborting\n"); 2966e689cf4aSJeff Kirsher err = -ENOMEM; 2967e689cf4aSJeff Kirsher goto err_out_iounmap; 2968e689cf4aSJeff Kirsher } 2969e689cf4aSJeff Kirsher 2970e689cf4aSJeff Kirsher if (gem_get_device_address(gp)) 2971e689cf4aSJeff Kirsher goto err_out_free_consistent; 2972e689cf4aSJeff Kirsher 2973e689cf4aSJeff Kirsher dev->netdev_ops = &gem_netdev_ops; 2974e689cf4aSJeff Kirsher netif_napi_add(dev, &gp->napi, gem_poll, 64); 2975e689cf4aSJeff Kirsher dev->ethtool_ops = &gem_ethtool_ops; 2976e689cf4aSJeff Kirsher dev->watchdog_timeo = 5 * HZ; 2977e689cf4aSJeff Kirsher dev->irq = pdev->irq; 2978e689cf4aSJeff Kirsher dev->dma = 0; 2979e689cf4aSJeff Kirsher 2980e689cf4aSJeff Kirsher /* Set that now, in case PM kicks in now */ 2981e689cf4aSJeff Kirsher pci_set_drvdata(pdev, dev); 2982e689cf4aSJeff Kirsher 2983e689cf4aSJeff Kirsher /* We can do scatter/gather and HW checksum */ 2984e689cf4aSJeff Kirsher dev->hw_features = NETIF_F_SG | NETIF_F_HW_CSUM; 2985e689cf4aSJeff Kirsher dev->features |= dev->hw_features | NETIF_F_RXCSUM; 2986e689cf4aSJeff Kirsher if (pci_using_dac) 2987e689cf4aSJeff Kirsher dev->features |= NETIF_F_HIGHDMA; 2988e689cf4aSJeff Kirsher 2989e689cf4aSJeff Kirsher /* Register with kernel */ 2990e689cf4aSJeff Kirsher if (register_netdev(dev)) { 2991e689cf4aSJeff Kirsher pr_err("Cannot register net device, aborting\n"); 2992e689cf4aSJeff Kirsher err = -ENOMEM; 2993e689cf4aSJeff Kirsher goto err_out_free_consistent; 2994e689cf4aSJeff Kirsher } 2995e689cf4aSJeff Kirsher 2996e689cf4aSJeff Kirsher /* Undo the get_cell with appropriate locking (we could use 2997e689cf4aSJeff Kirsher * ndo_init/uninit but that would be even more clumsy imho) 2998e689cf4aSJeff Kirsher */ 2999e689cf4aSJeff Kirsher rtnl_lock(); 3000e689cf4aSJeff Kirsher gem_put_cell(gp); 3001e689cf4aSJeff Kirsher rtnl_unlock(); 3002e689cf4aSJeff Kirsher 3003e689cf4aSJeff Kirsher netdev_info(dev, "Sun GEM (PCI) 10/100/1000BaseT Ethernet %pM\n", 3004e689cf4aSJeff Kirsher dev->dev_addr); 3005e689cf4aSJeff Kirsher return 0; 3006e689cf4aSJeff Kirsher 3007e689cf4aSJeff Kirsher err_out_free_consistent: 3008e689cf4aSJeff Kirsher gem_remove_one(pdev); 3009e689cf4aSJeff Kirsher err_out_iounmap: 3010e689cf4aSJeff Kirsher gem_put_cell(gp); 3011e689cf4aSJeff Kirsher iounmap(gp->regs); 3012e689cf4aSJeff Kirsher 3013e689cf4aSJeff Kirsher err_out_free_res: 3014e689cf4aSJeff Kirsher pci_release_regions(pdev); 3015e689cf4aSJeff Kirsher 3016e689cf4aSJeff Kirsher err_out_free_netdev: 3017e689cf4aSJeff Kirsher free_netdev(dev); 3018e689cf4aSJeff Kirsher err_disable_device: 3019e689cf4aSJeff Kirsher pci_disable_device(pdev); 3020e689cf4aSJeff Kirsher return err; 3021e689cf4aSJeff Kirsher 3022e689cf4aSJeff Kirsher } 3023e689cf4aSJeff Kirsher 3024e689cf4aSJeff Kirsher 3025e689cf4aSJeff Kirsher static struct pci_driver gem_driver = { 3026e689cf4aSJeff Kirsher .name = GEM_MODULE_NAME, 3027e689cf4aSJeff Kirsher .id_table = gem_pci_tbl, 3028e689cf4aSJeff Kirsher .probe = gem_init_one, 3029e689cf4aSJeff Kirsher .remove = gem_remove_one, 3030e689cf4aSJeff Kirsher #ifdef CONFIG_PM 3031e689cf4aSJeff Kirsher .suspend = gem_suspend, 3032e689cf4aSJeff Kirsher .resume = gem_resume, 3033e689cf4aSJeff Kirsher #endif /* CONFIG_PM */ 3034e689cf4aSJeff Kirsher }; 3035e689cf4aSJeff Kirsher 3036e689cf4aSJeff Kirsher static int __init gem_init(void) 3037e689cf4aSJeff Kirsher { 3038e689cf4aSJeff Kirsher return pci_register_driver(&gem_driver); 3039e689cf4aSJeff Kirsher } 3040e689cf4aSJeff Kirsher 3041e689cf4aSJeff Kirsher static void __exit gem_cleanup(void) 3042e689cf4aSJeff Kirsher { 3043e689cf4aSJeff Kirsher pci_unregister_driver(&gem_driver); 3044e689cf4aSJeff Kirsher } 3045e689cf4aSJeff Kirsher 3046e689cf4aSJeff Kirsher module_init(gem_init); 3047e689cf4aSJeff Kirsher module_exit(gem_cleanup); 3048