1aad970f1SDavid E. O'Brien /*- 2aad970f1SDavid E. O'Brien * Written by: yen_cw@myson.com.tw 3167aa833SJulian Elischer * Copyright (c) 2002 Myson Technology Inc. 4167aa833SJulian Elischer * All rights reserved. 5167aa833SJulian Elischer * 6167aa833SJulian Elischer * Redistribution and use in source and binary forms, with or without 7167aa833SJulian Elischer * modification, are permitted provided that the following conditions 8167aa833SJulian Elischer * are met: 9167aa833SJulian Elischer * 1. Redistributions of source code must retain the above copyright 10167aa833SJulian Elischer * notice, this list of conditions, and the following disclaimer, 11167aa833SJulian Elischer * without modification, immediately at the beginning of the file. 12167aa833SJulian Elischer * 2. The name of the author may not be used to endorse or promote products 13167aa833SJulian Elischer * derived from this software without specific prior written permission. 14167aa833SJulian Elischer * 15167aa833SJulian Elischer * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND 16167aa833SJulian Elischer * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 17167aa833SJulian Elischer * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 18167aa833SJulian Elischer * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE FOR 19167aa833SJulian Elischer * ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 20167aa833SJulian Elischer * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 21167aa833SJulian Elischer * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 22167aa833SJulian Elischer * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 23167aa833SJulian Elischer * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 24167aa833SJulian Elischer * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 25167aa833SJulian Elischer * SUCH DAMAGE. 26167aa833SJulian Elischer * 27aad970f1SDavid E. O'Brien * Myson fast ethernet PCI NIC driver, available at: http://www.myson.com.tw/ 28167aa833SJulian Elischer */ 298368cf8fSDavid E. O'Brien 308368cf8fSDavid E. O'Brien #include <sys/cdefs.h> 318368cf8fSDavid E. O'Brien __FBSDID("$FreeBSD$"); 328368cf8fSDavid E. O'Brien 33167aa833SJulian Elischer #include <sys/param.h> 34167aa833SJulian Elischer #include <sys/systm.h> 35167aa833SJulian Elischer #include <sys/sockio.h> 36167aa833SJulian Elischer #include <sys/mbuf.h> 37167aa833SJulian Elischer #include <sys/malloc.h> 38167aa833SJulian Elischer #include <sys/kernel.h> 39167aa833SJulian Elischer #include <sys/socket.h> 40167aa833SJulian Elischer #include <sys/queue.h> 41167aa833SJulian Elischer #include <sys/types.h> 42167aa833SJulian Elischer #include <sys/module.h> 43d4f567eeSJulian Elischer #include <sys/lock.h> 44d4f567eeSJulian Elischer #include <sys/mutex.h> 45167aa833SJulian Elischer 46167aa833SJulian Elischer #define NBPFILTER 1 47167aa833SJulian Elischer 48167aa833SJulian Elischer #include <net/if.h> 4976039bc8SGleb Smirnoff #include <net/if_var.h> 50167aa833SJulian Elischer #include <net/if_arp.h> 51167aa833SJulian Elischer #include <net/ethernet.h> 52167aa833SJulian Elischer #include <net/if_media.h> 53fc74a9f9SBrooks Davis #include <net/if_types.h> 54167aa833SJulian Elischer #include <net/if_dl.h> 55167aa833SJulian Elischer #include <net/bpf.h> 56167aa833SJulian Elischer 57167aa833SJulian Elischer #include <vm/vm.h> /* for vtophys */ 58167aa833SJulian Elischer #include <vm/pmap.h> /* for vtophys */ 59167aa833SJulian Elischer #include <machine/bus.h> 60167aa833SJulian Elischer #include <machine/resource.h> 61167aa833SJulian Elischer #include <sys/bus.h> 62167aa833SJulian Elischer #include <sys/rman.h> 63167aa833SJulian Elischer 6438d8c994SWarner Losh #include <dev/pci/pcireg.h> 6538d8c994SWarner Losh #include <dev/pci/pcivar.h> 66167aa833SJulian Elischer 67167aa833SJulian Elischer /* 68167aa833SJulian Elischer * #define MY_USEIOSPACE 69167aa833SJulian Elischer */ 70167aa833SJulian Elischer 71167aa833SJulian Elischer static int MY_USEIOSPACE = 1; 72167aa833SJulian Elischer 733238c6bdSRuslan Ermilov #ifdef MY_USEIOSPACE 74167aa833SJulian Elischer #define MY_RES SYS_RES_IOPORT 75167aa833SJulian Elischer #define MY_RID MY_PCI_LOIO 76167aa833SJulian Elischer #else 77167aa833SJulian Elischer #define MY_RES SYS_RES_MEMORY 78167aa833SJulian Elischer #define MY_RID MY_PCI_LOMEM 79167aa833SJulian Elischer #endif 80167aa833SJulian Elischer 81167aa833SJulian Elischer 82167aa833SJulian Elischer #include <dev/my/if_myreg.h> 83167aa833SJulian Elischer 84167aa833SJulian Elischer /* 85167aa833SJulian Elischer * Various supported device vendors/types and their names. 86167aa833SJulian Elischer */ 87167aa833SJulian Elischer struct my_type *my_info_tmp; 88167aa833SJulian Elischer static struct my_type my_devs[] = { 89167aa833SJulian Elischer {MYSONVENDORID, MTD800ID, "Myson MTD80X Based Fast Ethernet Card"}, 90167aa833SJulian Elischer {MYSONVENDORID, MTD803ID, "Myson MTD80X Based Fast Ethernet Card"}, 91167aa833SJulian Elischer {MYSONVENDORID, MTD891ID, "Myson MTD89X Based Giga Ethernet Card"}, 92167aa833SJulian Elischer {0, 0, NULL} 93167aa833SJulian Elischer }; 94167aa833SJulian Elischer 95167aa833SJulian Elischer /* 96167aa833SJulian Elischer * Various supported PHY vendors/types and their names. Note that this driver 97167aa833SJulian Elischer * will work with pretty much any MII-compliant PHY, so failure to positively 98167aa833SJulian Elischer * identify the chip is not a fatal error. 99167aa833SJulian Elischer */ 100167aa833SJulian Elischer static struct my_type my_phys[] = { 101167aa833SJulian Elischer {MysonPHYID0, MysonPHYID0, "<MYSON MTD981>"}, 102167aa833SJulian Elischer {SeeqPHYID0, SeeqPHYID0, "<SEEQ 80225>"}, 103167aa833SJulian Elischer {AhdocPHYID0, AhdocPHYID0, "<AHDOC 101>"}, 104167aa833SJulian Elischer {MarvellPHYID0, MarvellPHYID0, "<MARVELL 88E1000>"}, 105167aa833SJulian Elischer {LevelOnePHYID0, LevelOnePHYID0, "<LevelOne LXT1000>"}, 106167aa833SJulian Elischer {0, 0, "<MII-compliant physical interface>"} 107167aa833SJulian Elischer }; 108167aa833SJulian Elischer 109167aa833SJulian Elischer static int my_probe(device_t); 110167aa833SJulian Elischer static int my_attach(device_t); 111167aa833SJulian Elischer static int my_detach(device_t); 112167aa833SJulian Elischer static int my_newbuf(struct my_softc *, struct my_chain_onefrag *); 113167aa833SJulian Elischer static int my_encap(struct my_softc *, struct my_chain *, struct mbuf *); 114167aa833SJulian Elischer static void my_rxeof(struct my_softc *); 115167aa833SJulian Elischer static void my_txeof(struct my_softc *); 116167aa833SJulian Elischer static void my_txeoc(struct my_softc *); 117167aa833SJulian Elischer static void my_intr(void *); 118167aa833SJulian Elischer static void my_start(struct ifnet *); 119ca5fc32dSJohn Baldwin static void my_start_locked(struct ifnet *); 120167aa833SJulian Elischer static int my_ioctl(struct ifnet *, u_long, caddr_t); 121167aa833SJulian Elischer static void my_init(void *); 122ca5fc32dSJohn Baldwin static void my_init_locked(struct my_softc *); 123167aa833SJulian Elischer static void my_stop(struct my_softc *); 124d4e576c4SJohn Baldwin static void my_autoneg_timeout(void *); 125d4e576c4SJohn Baldwin static void my_watchdog(void *); 126174ed15eSWarner Losh static int my_shutdown(device_t); 127167aa833SJulian Elischer static int my_ifmedia_upd(struct ifnet *); 128167aa833SJulian Elischer static void my_ifmedia_sts(struct ifnet *, struct ifmediareq *); 129167aa833SJulian Elischer static u_int16_t my_phy_readreg(struct my_softc *, int); 130167aa833SJulian Elischer static void my_phy_writereg(struct my_softc *, int, int); 131167aa833SJulian Elischer static void my_autoneg_xmit(struct my_softc *); 132167aa833SJulian Elischer static void my_autoneg_mii(struct my_softc *, int, int); 133167aa833SJulian Elischer static void my_setmode_mii(struct my_softc *, int); 134167aa833SJulian Elischer static void my_getmode_mii(struct my_softc *); 135167aa833SJulian Elischer static void my_setcfg(struct my_softc *, int); 136167aa833SJulian Elischer static void my_setmulti(struct my_softc *); 137167aa833SJulian Elischer static void my_reset(struct my_softc *); 138167aa833SJulian Elischer static int my_list_rx_init(struct my_softc *); 139167aa833SJulian Elischer static int my_list_tx_init(struct my_softc *); 140167aa833SJulian Elischer static long my_send_cmd_to_phy(struct my_softc *, int, int); 141167aa833SJulian Elischer 14229f19445SAlfred Perlstein #define MY_SETBIT(sc, reg, x) CSR_WRITE_4(sc, reg, CSR_READ_4(sc, reg) | (x)) 14329f19445SAlfred Perlstein #define MY_CLRBIT(sc, reg, x) CSR_WRITE_4(sc, reg, CSR_READ_4(sc, reg) & ~(x)) 144167aa833SJulian Elischer 145167aa833SJulian Elischer static device_method_t my_methods[] = { 146167aa833SJulian Elischer /* Device interface */ 147167aa833SJulian Elischer DEVMETHOD(device_probe, my_probe), 148167aa833SJulian Elischer DEVMETHOD(device_attach, my_attach), 149167aa833SJulian Elischer DEVMETHOD(device_detach, my_detach), 150167aa833SJulian Elischer DEVMETHOD(device_shutdown, my_shutdown), 151167aa833SJulian Elischer 15261bfd867SSofian Brabez DEVMETHOD_END 153167aa833SJulian Elischer }; 154167aa833SJulian Elischer 155167aa833SJulian Elischer static driver_t my_driver = { 156167aa833SJulian Elischer "my", 157167aa833SJulian Elischer my_methods, 158167aa833SJulian Elischer sizeof(struct my_softc) 159167aa833SJulian Elischer }; 160167aa833SJulian Elischer 161167aa833SJulian Elischer static devclass_t my_devclass; 162167aa833SJulian Elischer 163f246e4a1SMatthew N. Dodd DRIVER_MODULE(my, pci, my_driver, my_devclass, 0, 0); 164f246e4a1SMatthew N. Dodd MODULE_DEPEND(my, pci, 1, 1, 1); 165f246e4a1SMatthew N. Dodd MODULE_DEPEND(my, ether, 1, 1, 1); 166167aa833SJulian Elischer 167167aa833SJulian Elischer static long 168167aa833SJulian Elischer my_send_cmd_to_phy(struct my_softc * sc, int opcode, int regad) 169167aa833SJulian Elischer { 170167aa833SJulian Elischer long miir; 171167aa833SJulian Elischer int i; 172167aa833SJulian Elischer int mask, data; 173167aa833SJulian Elischer 174ca5fc32dSJohn Baldwin MY_LOCK_ASSERT(sc); 175167aa833SJulian Elischer 176167aa833SJulian Elischer /* enable MII output */ 177167aa833SJulian Elischer miir = CSR_READ_4(sc, MY_MANAGEMENT); 178167aa833SJulian Elischer miir &= 0xfffffff0; 179167aa833SJulian Elischer 180167aa833SJulian Elischer miir |= MY_MASK_MIIR_MII_WRITE + MY_MASK_MIIR_MII_MDO; 181167aa833SJulian Elischer 182167aa833SJulian Elischer /* send 32 1's preamble */ 183167aa833SJulian Elischer for (i = 0; i < 32; i++) { 184167aa833SJulian Elischer /* low MDC; MDO is already high (miir) */ 185167aa833SJulian Elischer miir &= ~MY_MASK_MIIR_MII_MDC; 186167aa833SJulian Elischer CSR_WRITE_4(sc, MY_MANAGEMENT, miir); 187167aa833SJulian Elischer 188167aa833SJulian Elischer /* high MDC */ 189167aa833SJulian Elischer miir |= MY_MASK_MIIR_MII_MDC; 190167aa833SJulian Elischer CSR_WRITE_4(sc, MY_MANAGEMENT, miir); 191167aa833SJulian Elischer } 192167aa833SJulian Elischer 193167aa833SJulian Elischer /* calculate ST+OP+PHYAD+REGAD+TA */ 194167aa833SJulian Elischer data = opcode | (sc->my_phy_addr << 7) | (regad << 2); 195167aa833SJulian Elischer 196167aa833SJulian Elischer /* sent out */ 197167aa833SJulian Elischer mask = 0x8000; 198167aa833SJulian Elischer while (mask) { 199167aa833SJulian Elischer /* low MDC, prepare MDO */ 200167aa833SJulian Elischer miir &= ~(MY_MASK_MIIR_MII_MDC + MY_MASK_MIIR_MII_MDO); 201167aa833SJulian Elischer if (mask & data) 202167aa833SJulian Elischer miir |= MY_MASK_MIIR_MII_MDO; 203167aa833SJulian Elischer 204167aa833SJulian Elischer CSR_WRITE_4(sc, MY_MANAGEMENT, miir); 205167aa833SJulian Elischer /* high MDC */ 206167aa833SJulian Elischer miir |= MY_MASK_MIIR_MII_MDC; 207167aa833SJulian Elischer CSR_WRITE_4(sc, MY_MANAGEMENT, miir); 208167aa833SJulian Elischer DELAY(30); 209167aa833SJulian Elischer 210167aa833SJulian Elischer /* next */ 211167aa833SJulian Elischer mask >>= 1; 212167aa833SJulian Elischer if (mask == 0x2 && opcode == MY_OP_READ) 213167aa833SJulian Elischer miir &= ~MY_MASK_MIIR_MII_WRITE; 214167aa833SJulian Elischer } 215167aa833SJulian Elischer 216167aa833SJulian Elischer return miir; 217167aa833SJulian Elischer } 218167aa833SJulian Elischer 219167aa833SJulian Elischer 220167aa833SJulian Elischer static u_int16_t 221167aa833SJulian Elischer my_phy_readreg(struct my_softc * sc, int reg) 222167aa833SJulian Elischer { 223167aa833SJulian Elischer long miir; 224167aa833SJulian Elischer int mask, data; 225167aa833SJulian Elischer 226ca5fc32dSJohn Baldwin MY_LOCK_ASSERT(sc); 227167aa833SJulian Elischer 228167aa833SJulian Elischer if (sc->my_info->my_did == MTD803ID) 229167aa833SJulian Elischer data = CSR_READ_2(sc, MY_PHYBASE + reg * 2); 230167aa833SJulian Elischer else { 231167aa833SJulian Elischer miir = my_send_cmd_to_phy(sc, MY_OP_READ, reg); 232167aa833SJulian Elischer 233167aa833SJulian Elischer /* read data */ 234167aa833SJulian Elischer mask = 0x8000; 235167aa833SJulian Elischer data = 0; 236167aa833SJulian Elischer while (mask) { 237167aa833SJulian Elischer /* low MDC */ 238167aa833SJulian Elischer miir &= ~MY_MASK_MIIR_MII_MDC; 239167aa833SJulian Elischer CSR_WRITE_4(sc, MY_MANAGEMENT, miir); 240167aa833SJulian Elischer 241167aa833SJulian Elischer /* read MDI */ 242167aa833SJulian Elischer miir = CSR_READ_4(sc, MY_MANAGEMENT); 243167aa833SJulian Elischer if (miir & MY_MASK_MIIR_MII_MDI) 244167aa833SJulian Elischer data |= mask; 245167aa833SJulian Elischer 246167aa833SJulian Elischer /* high MDC, and wait */ 247167aa833SJulian Elischer miir |= MY_MASK_MIIR_MII_MDC; 248167aa833SJulian Elischer CSR_WRITE_4(sc, MY_MANAGEMENT, miir); 249167aa833SJulian Elischer DELAY(30); 250167aa833SJulian Elischer 251167aa833SJulian Elischer /* next */ 252167aa833SJulian Elischer mask >>= 1; 253167aa833SJulian Elischer } 254167aa833SJulian Elischer 255167aa833SJulian Elischer /* low MDC */ 256167aa833SJulian Elischer miir &= ~MY_MASK_MIIR_MII_MDC; 257167aa833SJulian Elischer CSR_WRITE_4(sc, MY_MANAGEMENT, miir); 258167aa833SJulian Elischer } 259167aa833SJulian Elischer 260167aa833SJulian Elischer return (u_int16_t) data; 261167aa833SJulian Elischer } 262167aa833SJulian Elischer 263167aa833SJulian Elischer 264167aa833SJulian Elischer static void 265167aa833SJulian Elischer my_phy_writereg(struct my_softc * sc, int reg, int data) 266167aa833SJulian Elischer { 267167aa833SJulian Elischer long miir; 268167aa833SJulian Elischer int mask; 269167aa833SJulian Elischer 270ca5fc32dSJohn Baldwin MY_LOCK_ASSERT(sc); 271167aa833SJulian Elischer 272167aa833SJulian Elischer if (sc->my_info->my_did == MTD803ID) 273167aa833SJulian Elischer CSR_WRITE_2(sc, MY_PHYBASE + reg * 2, data); 274167aa833SJulian Elischer else { 275167aa833SJulian Elischer miir = my_send_cmd_to_phy(sc, MY_OP_WRITE, reg); 276167aa833SJulian Elischer 277167aa833SJulian Elischer /* write data */ 278167aa833SJulian Elischer mask = 0x8000; 279167aa833SJulian Elischer while (mask) { 280167aa833SJulian Elischer /* low MDC, prepare MDO */ 281167aa833SJulian Elischer miir &= ~(MY_MASK_MIIR_MII_MDC + MY_MASK_MIIR_MII_MDO); 282167aa833SJulian Elischer if (mask & data) 283167aa833SJulian Elischer miir |= MY_MASK_MIIR_MII_MDO; 284167aa833SJulian Elischer CSR_WRITE_4(sc, MY_MANAGEMENT, miir); 285167aa833SJulian Elischer DELAY(1); 286167aa833SJulian Elischer 287167aa833SJulian Elischer /* high MDC */ 288167aa833SJulian Elischer miir |= MY_MASK_MIIR_MII_MDC; 289167aa833SJulian Elischer CSR_WRITE_4(sc, MY_MANAGEMENT, miir); 290167aa833SJulian Elischer DELAY(1); 291167aa833SJulian Elischer 292167aa833SJulian Elischer /* next */ 293167aa833SJulian Elischer mask >>= 1; 294167aa833SJulian Elischer } 295167aa833SJulian Elischer 296167aa833SJulian Elischer /* low MDC */ 297167aa833SJulian Elischer miir &= ~MY_MASK_MIIR_MII_MDC; 298167aa833SJulian Elischer CSR_WRITE_4(sc, MY_MANAGEMENT, miir); 299167aa833SJulian Elischer } 300167aa833SJulian Elischer return; 301167aa833SJulian Elischer } 302167aa833SJulian Elischer 303167aa833SJulian Elischer 304167aa833SJulian Elischer /* 305167aa833SJulian Elischer * Program the 64-bit multicast hash filter. 306167aa833SJulian Elischer */ 307167aa833SJulian Elischer static void 308167aa833SJulian Elischer my_setmulti(struct my_softc * sc) 309167aa833SJulian Elischer { 310167aa833SJulian Elischer struct ifnet *ifp; 311167aa833SJulian Elischer int h = 0; 312167aa833SJulian Elischer u_int32_t hashes[2] = {0, 0}; 313167aa833SJulian Elischer struct ifmultiaddr *ifma; 314167aa833SJulian Elischer u_int32_t rxfilt; 315167aa833SJulian Elischer int mcnt = 0; 316167aa833SJulian Elischer 317ca5fc32dSJohn Baldwin MY_LOCK_ASSERT(sc); 318167aa833SJulian Elischer 319fc74a9f9SBrooks Davis ifp = sc->my_ifp; 320167aa833SJulian Elischer 321167aa833SJulian Elischer rxfilt = CSR_READ_4(sc, MY_TCRRCR); 322167aa833SJulian Elischer 323167aa833SJulian Elischer if (ifp->if_flags & IFF_ALLMULTI || ifp->if_flags & IFF_PROMISC) { 324167aa833SJulian Elischer rxfilt |= MY_AM; 325167aa833SJulian Elischer CSR_WRITE_4(sc, MY_TCRRCR, rxfilt); 326167aa833SJulian Elischer CSR_WRITE_4(sc, MY_MAR0, 0xFFFFFFFF); 327167aa833SJulian Elischer CSR_WRITE_4(sc, MY_MAR1, 0xFFFFFFFF); 328167aa833SJulian Elischer 329167aa833SJulian Elischer return; 330167aa833SJulian Elischer } 331167aa833SJulian Elischer /* first, zot all the existing hash bits */ 332167aa833SJulian Elischer CSR_WRITE_4(sc, MY_MAR0, 0); 333167aa833SJulian Elischer CSR_WRITE_4(sc, MY_MAR1, 0); 334167aa833SJulian Elischer 335167aa833SJulian Elischer /* now program new ones */ 336eb956cd0SRobert Watson if_maddr_rlock(ifp); 337167aa833SJulian Elischer TAILQ_FOREACH(ifma, &ifp->if_multiaddrs, ifma_link) { 338167aa833SJulian Elischer if (ifma->ifma_addr->sa_family != AF_LINK) 339167aa833SJulian Elischer continue; 3400e939c0cSChristian Weisgerber h = ~ether_crc32_be(LLADDR((struct sockaddr_dl *) 3410e939c0cSChristian Weisgerber ifma->ifma_addr), ETHER_ADDR_LEN) >> 26; 342167aa833SJulian Elischer if (h < 32) 343167aa833SJulian Elischer hashes[0] |= (1 << h); 344167aa833SJulian Elischer else 345167aa833SJulian Elischer hashes[1] |= (1 << (h - 32)); 346167aa833SJulian Elischer mcnt++; 347167aa833SJulian Elischer } 348eb956cd0SRobert Watson if_maddr_runlock(ifp); 349167aa833SJulian Elischer 350167aa833SJulian Elischer if (mcnt) 351167aa833SJulian Elischer rxfilt |= MY_AM; 352167aa833SJulian Elischer else 353167aa833SJulian Elischer rxfilt &= ~MY_AM; 354167aa833SJulian Elischer CSR_WRITE_4(sc, MY_MAR0, hashes[0]); 355167aa833SJulian Elischer CSR_WRITE_4(sc, MY_MAR1, hashes[1]); 356167aa833SJulian Elischer CSR_WRITE_4(sc, MY_TCRRCR, rxfilt); 357167aa833SJulian Elischer return; 358167aa833SJulian Elischer } 359167aa833SJulian Elischer 360167aa833SJulian Elischer /* 361167aa833SJulian Elischer * Initiate an autonegotiation session. 362167aa833SJulian Elischer */ 363167aa833SJulian Elischer static void 364167aa833SJulian Elischer my_autoneg_xmit(struct my_softc * sc) 365167aa833SJulian Elischer { 366167aa833SJulian Elischer u_int16_t phy_sts = 0; 367167aa833SJulian Elischer 368ca5fc32dSJohn Baldwin MY_LOCK_ASSERT(sc); 369167aa833SJulian Elischer 370167aa833SJulian Elischer my_phy_writereg(sc, PHY_BMCR, PHY_BMCR_RESET); 371167aa833SJulian Elischer DELAY(500); 372167aa833SJulian Elischer while (my_phy_readreg(sc, PHY_BMCR) & PHY_BMCR_RESET); 373167aa833SJulian Elischer 374167aa833SJulian Elischer phy_sts = my_phy_readreg(sc, PHY_BMCR); 375167aa833SJulian Elischer phy_sts |= PHY_BMCR_AUTONEGENBL | PHY_BMCR_AUTONEGRSTR; 376167aa833SJulian Elischer my_phy_writereg(sc, PHY_BMCR, phy_sts); 377167aa833SJulian Elischer 378167aa833SJulian Elischer return; 379167aa833SJulian Elischer } 380167aa833SJulian Elischer 381d4e576c4SJohn Baldwin static void 382d4e576c4SJohn Baldwin my_autoneg_timeout(void *arg) 383d4e576c4SJohn Baldwin { 384d4e576c4SJohn Baldwin struct my_softc *sc; 385d4e576c4SJohn Baldwin 386d4e576c4SJohn Baldwin sc = arg; 387d4e576c4SJohn Baldwin MY_LOCK_ASSERT(sc); 388d4e576c4SJohn Baldwin my_autoneg_mii(sc, MY_FLAG_DELAYTIMEO, 1); 389d4e576c4SJohn Baldwin } 390167aa833SJulian Elischer 391167aa833SJulian Elischer /* 392167aa833SJulian Elischer * Invoke autonegotiation on a PHY. 393167aa833SJulian Elischer */ 394167aa833SJulian Elischer static void 395167aa833SJulian Elischer my_autoneg_mii(struct my_softc * sc, int flag, int verbose) 396167aa833SJulian Elischer { 397167aa833SJulian Elischer u_int16_t phy_sts = 0, media, advert, ability; 398167aa833SJulian Elischer u_int16_t ability2 = 0; 399167aa833SJulian Elischer struct ifnet *ifp; 400167aa833SJulian Elischer struct ifmedia *ifm; 401167aa833SJulian Elischer 402ca5fc32dSJohn Baldwin MY_LOCK_ASSERT(sc); 403167aa833SJulian Elischer 404167aa833SJulian Elischer ifm = &sc->ifmedia; 405fc74a9f9SBrooks Davis ifp = sc->my_ifp; 406167aa833SJulian Elischer 407167aa833SJulian Elischer ifm->ifm_media = IFM_ETHER | IFM_AUTO; 408167aa833SJulian Elischer 409167aa833SJulian Elischer #ifndef FORCE_AUTONEG_TFOUR 410167aa833SJulian Elischer /* 411167aa833SJulian Elischer * First, see if autoneg is supported. If not, there's no point in 412167aa833SJulian Elischer * continuing. 413167aa833SJulian Elischer */ 414167aa833SJulian Elischer phy_sts = my_phy_readreg(sc, PHY_BMSR); 415167aa833SJulian Elischer if (!(phy_sts & PHY_BMSR_CANAUTONEG)) { 416167aa833SJulian Elischer if (verbose) 4176b9f5c94SGleb Smirnoff device_printf(sc->my_dev, 4186b9f5c94SGleb Smirnoff "autonegotiation not supported\n"); 419167aa833SJulian Elischer ifm->ifm_media = IFM_ETHER | IFM_10_T | IFM_HDX; 420167aa833SJulian Elischer return; 421167aa833SJulian Elischer } 422167aa833SJulian Elischer #endif 423167aa833SJulian Elischer switch (flag) { 424167aa833SJulian Elischer case MY_FLAG_FORCEDELAY: 425167aa833SJulian Elischer /* 426167aa833SJulian Elischer * XXX Never use this option anywhere but in the probe 427167aa833SJulian Elischer * routine: making the kernel stop dead in its tracks for 428167aa833SJulian Elischer * three whole seconds after we've gone multi-user is really 429167aa833SJulian Elischer * bad manners. 430167aa833SJulian Elischer */ 431167aa833SJulian Elischer my_autoneg_xmit(sc); 432167aa833SJulian Elischer DELAY(5000000); 433167aa833SJulian Elischer break; 434167aa833SJulian Elischer case MY_FLAG_SCHEDDELAY: 435167aa833SJulian Elischer /* 436167aa833SJulian Elischer * Wait for the transmitter to go idle before starting an 437167aa833SJulian Elischer * autoneg session, otherwise my_start() may clobber our 438167aa833SJulian Elischer * timeout, and we don't want to allow transmission during an 439167aa833SJulian Elischer * autoneg session since that can screw it up. 440167aa833SJulian Elischer */ 441167aa833SJulian Elischer if (sc->my_cdata.my_tx_head != NULL) { 442167aa833SJulian Elischer sc->my_want_auto = 1; 443167aa833SJulian Elischer MY_UNLOCK(sc); 444167aa833SJulian Elischer return; 445167aa833SJulian Elischer } 446167aa833SJulian Elischer my_autoneg_xmit(sc); 447d4e576c4SJohn Baldwin callout_reset(&sc->my_autoneg_timer, hz * 5, my_autoneg_timeout, 448d4e576c4SJohn Baldwin sc); 449167aa833SJulian Elischer sc->my_autoneg = 1; 450167aa833SJulian Elischer sc->my_want_auto = 0; 451167aa833SJulian Elischer return; 452167aa833SJulian Elischer case MY_FLAG_DELAYTIMEO: 453d4e576c4SJohn Baldwin callout_stop(&sc->my_autoneg_timer); 454167aa833SJulian Elischer sc->my_autoneg = 0; 455167aa833SJulian Elischer break; 456167aa833SJulian Elischer default: 4576b9f5c94SGleb Smirnoff device_printf(sc->my_dev, "invalid autoneg flag: %d\n", flag); 458167aa833SJulian Elischer return; 459167aa833SJulian Elischer } 460167aa833SJulian Elischer 461167aa833SJulian Elischer if (my_phy_readreg(sc, PHY_BMSR) & PHY_BMSR_AUTONEGCOMP) { 462167aa833SJulian Elischer if (verbose) 4636b9f5c94SGleb Smirnoff device_printf(sc->my_dev, "autoneg complete, "); 464167aa833SJulian Elischer phy_sts = my_phy_readreg(sc, PHY_BMSR); 465167aa833SJulian Elischer } else { 466167aa833SJulian Elischer if (verbose) 4676b9f5c94SGleb Smirnoff device_printf(sc->my_dev, "autoneg not complete, "); 468167aa833SJulian Elischer } 469167aa833SJulian Elischer 470167aa833SJulian Elischer media = my_phy_readreg(sc, PHY_BMCR); 471167aa833SJulian Elischer 472167aa833SJulian Elischer /* Link is good. Report modes and set duplex mode. */ 473167aa833SJulian Elischer if (my_phy_readreg(sc, PHY_BMSR) & PHY_BMSR_LINKSTAT) { 474167aa833SJulian Elischer if (verbose) 4756b9f5c94SGleb Smirnoff device_printf(sc->my_dev, "link status good. "); 476167aa833SJulian Elischer advert = my_phy_readreg(sc, PHY_ANAR); 477167aa833SJulian Elischer ability = my_phy_readreg(sc, PHY_LPAR); 478167aa833SJulian Elischer if ((sc->my_pinfo->my_vid == MarvellPHYID0) || 479167aa833SJulian Elischer (sc->my_pinfo->my_vid == LevelOnePHYID0)) { 480167aa833SJulian Elischer ability2 = my_phy_readreg(sc, PHY_1000SR); 481167aa833SJulian Elischer if (ability2 & PHY_1000SR_1000BTXFULL) { 482167aa833SJulian Elischer advert = 0; 483167aa833SJulian Elischer ability = 0; 484167aa833SJulian Elischer /* 485167aa833SJulian Elischer * this version did not support 1000M, 486167aa833SJulian Elischer * ifm->ifm_media = 487b418ad5cSPoul-Henning Kamp * IFM_ETHER|IFM_1000_T|IFM_FDX; 488167aa833SJulian Elischer */ 489167aa833SJulian Elischer ifm->ifm_media = 490167aa833SJulian Elischer IFM_ETHER | IFM_100_TX | IFM_FDX; 491167aa833SJulian Elischer media &= ~PHY_BMCR_SPEEDSEL; 492167aa833SJulian Elischer media |= PHY_BMCR_1000; 493167aa833SJulian Elischer media |= PHY_BMCR_DUPLEX; 494167aa833SJulian Elischer printf("(full-duplex, 1000Mbps)\n"); 495167aa833SJulian Elischer } else if (ability2 & PHY_1000SR_1000BTXHALF) { 496167aa833SJulian Elischer advert = 0; 497167aa833SJulian Elischer ability = 0; 498167aa833SJulian Elischer /* 499167aa833SJulian Elischer * this version did not support 1000M, 500b418ad5cSPoul-Henning Kamp * ifm->ifm_media = IFM_ETHER|IFM_1000_T; 501167aa833SJulian Elischer */ 502167aa833SJulian Elischer ifm->ifm_media = IFM_ETHER | IFM_100_TX; 503167aa833SJulian Elischer media &= ~PHY_BMCR_SPEEDSEL; 504167aa833SJulian Elischer media &= ~PHY_BMCR_DUPLEX; 505167aa833SJulian Elischer media |= PHY_BMCR_1000; 506167aa833SJulian Elischer printf("(half-duplex, 1000Mbps)\n"); 507167aa833SJulian Elischer } 508167aa833SJulian Elischer } 509167aa833SJulian Elischer if (advert & PHY_ANAR_100BT4 && ability & PHY_ANAR_100BT4) { 510167aa833SJulian Elischer ifm->ifm_media = IFM_ETHER | IFM_100_T4; 511167aa833SJulian Elischer media |= PHY_BMCR_SPEEDSEL; 512167aa833SJulian Elischer media &= ~PHY_BMCR_DUPLEX; 513167aa833SJulian Elischer printf("(100baseT4)\n"); 514167aa833SJulian Elischer } else if (advert & PHY_ANAR_100BTXFULL && 515167aa833SJulian Elischer ability & PHY_ANAR_100BTXFULL) { 516167aa833SJulian Elischer ifm->ifm_media = IFM_ETHER | IFM_100_TX | IFM_FDX; 517167aa833SJulian Elischer media |= PHY_BMCR_SPEEDSEL; 518167aa833SJulian Elischer media |= PHY_BMCR_DUPLEX; 519167aa833SJulian Elischer printf("(full-duplex, 100Mbps)\n"); 520167aa833SJulian Elischer } else if (advert & PHY_ANAR_100BTXHALF && 521167aa833SJulian Elischer ability & PHY_ANAR_100BTXHALF) { 522167aa833SJulian Elischer ifm->ifm_media = IFM_ETHER | IFM_100_TX | IFM_HDX; 523167aa833SJulian Elischer media |= PHY_BMCR_SPEEDSEL; 524167aa833SJulian Elischer media &= ~PHY_BMCR_DUPLEX; 525167aa833SJulian Elischer printf("(half-duplex, 100Mbps)\n"); 526167aa833SJulian Elischer } else if (advert & PHY_ANAR_10BTFULL && 527167aa833SJulian Elischer ability & PHY_ANAR_10BTFULL) { 528167aa833SJulian Elischer ifm->ifm_media = IFM_ETHER | IFM_10_T | IFM_FDX; 529167aa833SJulian Elischer media &= ~PHY_BMCR_SPEEDSEL; 530167aa833SJulian Elischer media |= PHY_BMCR_DUPLEX; 531167aa833SJulian Elischer printf("(full-duplex, 10Mbps)\n"); 532167aa833SJulian Elischer } else if (advert) { 533167aa833SJulian Elischer ifm->ifm_media = IFM_ETHER | IFM_10_T | IFM_HDX; 534167aa833SJulian Elischer media &= ~PHY_BMCR_SPEEDSEL; 535167aa833SJulian Elischer media &= ~PHY_BMCR_DUPLEX; 536167aa833SJulian Elischer printf("(half-duplex, 10Mbps)\n"); 537167aa833SJulian Elischer } 538167aa833SJulian Elischer media &= ~PHY_BMCR_AUTONEGENBL; 539167aa833SJulian Elischer 540167aa833SJulian Elischer /* Set ASIC's duplex mode to match the PHY. */ 541167aa833SJulian Elischer my_phy_writereg(sc, PHY_BMCR, media); 542167aa833SJulian Elischer my_setcfg(sc, media); 543167aa833SJulian Elischer } else { 544167aa833SJulian Elischer if (verbose) 5456b9f5c94SGleb Smirnoff device_printf(sc->my_dev, "no carrier\n"); 546167aa833SJulian Elischer } 547167aa833SJulian Elischer 548ca5fc32dSJohn Baldwin my_init_locked(sc); 549167aa833SJulian Elischer if (sc->my_tx_pend) { 550167aa833SJulian Elischer sc->my_autoneg = 0; 551167aa833SJulian Elischer sc->my_tx_pend = 0; 552ca5fc32dSJohn Baldwin my_start_locked(ifp); 553167aa833SJulian Elischer } 554167aa833SJulian Elischer return; 555167aa833SJulian Elischer } 556167aa833SJulian Elischer 557167aa833SJulian Elischer /* 558167aa833SJulian Elischer * To get PHY ability. 559167aa833SJulian Elischer */ 560167aa833SJulian Elischer static void 561167aa833SJulian Elischer my_getmode_mii(struct my_softc * sc) 562167aa833SJulian Elischer { 563167aa833SJulian Elischer u_int16_t bmsr; 564167aa833SJulian Elischer struct ifnet *ifp; 565167aa833SJulian Elischer 566ca5fc32dSJohn Baldwin MY_LOCK_ASSERT(sc); 567fc74a9f9SBrooks Davis ifp = sc->my_ifp; 568167aa833SJulian Elischer bmsr = my_phy_readreg(sc, PHY_BMSR); 569167aa833SJulian Elischer if (bootverbose) 5706b9f5c94SGleb Smirnoff device_printf(sc->my_dev, "PHY status word: %x\n", bmsr); 571167aa833SJulian Elischer 572167aa833SJulian Elischer /* fallback */ 573167aa833SJulian Elischer sc->ifmedia.ifm_media = IFM_ETHER | IFM_10_T | IFM_HDX; 574167aa833SJulian Elischer 575167aa833SJulian Elischer if (bmsr & PHY_BMSR_10BTHALF) { 576167aa833SJulian Elischer if (bootverbose) 5776b9f5c94SGleb Smirnoff device_printf(sc->my_dev, 5786b9f5c94SGleb Smirnoff "10Mbps half-duplex mode supported\n"); 579167aa833SJulian Elischer ifmedia_add(&sc->ifmedia, IFM_ETHER | IFM_10_T | IFM_HDX, 580167aa833SJulian Elischer 0, NULL); 581167aa833SJulian Elischer ifmedia_add(&sc->ifmedia, IFM_ETHER | IFM_10_T, 0, NULL); 582167aa833SJulian Elischer } 583167aa833SJulian Elischer if (bmsr & PHY_BMSR_10BTFULL) { 584167aa833SJulian Elischer if (bootverbose) 5856b9f5c94SGleb Smirnoff device_printf(sc->my_dev, 5866b9f5c94SGleb Smirnoff "10Mbps full-duplex mode supported\n"); 587167aa833SJulian Elischer 588167aa833SJulian Elischer ifmedia_add(&sc->ifmedia, IFM_ETHER | IFM_10_T | IFM_FDX, 589167aa833SJulian Elischer 0, NULL); 590167aa833SJulian Elischer sc->ifmedia.ifm_media = IFM_ETHER | IFM_10_T | IFM_FDX; 591167aa833SJulian Elischer } 592167aa833SJulian Elischer if (bmsr & PHY_BMSR_100BTXHALF) { 593167aa833SJulian Elischer if (bootverbose) 5946b9f5c94SGleb Smirnoff device_printf(sc->my_dev, 5956b9f5c94SGleb Smirnoff "100Mbps half-duplex mode supported\n"); 596167aa833SJulian Elischer ifp->if_baudrate = 100000000; 597167aa833SJulian Elischer ifmedia_add(&sc->ifmedia, IFM_ETHER | IFM_100_TX, 0, NULL); 598167aa833SJulian Elischer ifmedia_add(&sc->ifmedia, IFM_ETHER | IFM_100_TX | IFM_HDX, 599167aa833SJulian Elischer 0, NULL); 600167aa833SJulian Elischer sc->ifmedia.ifm_media = IFM_ETHER | IFM_100_TX | IFM_HDX; 601167aa833SJulian Elischer } 602167aa833SJulian Elischer if (bmsr & PHY_BMSR_100BTXFULL) { 603167aa833SJulian Elischer if (bootverbose) 6046b9f5c94SGleb Smirnoff device_printf(sc->my_dev, 6056b9f5c94SGleb Smirnoff "100Mbps full-duplex mode supported\n"); 606167aa833SJulian Elischer ifp->if_baudrate = 100000000; 607167aa833SJulian Elischer ifmedia_add(&sc->ifmedia, IFM_ETHER | IFM_100_TX | IFM_FDX, 608167aa833SJulian Elischer 0, NULL); 609167aa833SJulian Elischer sc->ifmedia.ifm_media = IFM_ETHER | IFM_100_TX | IFM_FDX; 610167aa833SJulian Elischer } 611167aa833SJulian Elischer /* Some also support 100BaseT4. */ 612167aa833SJulian Elischer if (bmsr & PHY_BMSR_100BT4) { 613167aa833SJulian Elischer if (bootverbose) 6146b9f5c94SGleb Smirnoff device_printf(sc->my_dev, "100baseT4 mode supported\n"); 615167aa833SJulian Elischer ifp->if_baudrate = 100000000; 616167aa833SJulian Elischer ifmedia_add(&sc->ifmedia, IFM_ETHER | IFM_100_T4, 0, NULL); 617167aa833SJulian Elischer sc->ifmedia.ifm_media = IFM_ETHER | IFM_100_T4; 618167aa833SJulian Elischer #ifdef FORCE_AUTONEG_TFOUR 619167aa833SJulian Elischer if (bootverbose) 6206b9f5c94SGleb Smirnoff device_printf(sc->my_dev, 6216b9f5c94SGleb Smirnoff "forcing on autoneg support for BT4\n"); 622167aa833SJulian Elischer ifmedia_add(&sc->ifmedia, IFM_ETHER | IFM_AUTO, 0 NULL): 623167aa833SJulian Elischer sc->ifmedia.ifm_media = IFM_ETHER | IFM_AUTO; 624167aa833SJulian Elischer #endif 625167aa833SJulian Elischer } 6260cde2d13SJulian Elischer #if 0 /* this version did not support 1000M, */ 627167aa833SJulian Elischer if (sc->my_pinfo->my_vid == MarvellPHYID0) { 628167aa833SJulian Elischer if (bootverbose) 6296b9f5c94SGleb Smirnoff device_printf(sc->my_dev, 6306b9f5c94SGleb Smirnoff "1000Mbps half-duplex mode supported\n"); 631167aa833SJulian Elischer 632167aa833SJulian Elischer ifp->if_baudrate = 1000000000; 633b418ad5cSPoul-Henning Kamp ifmedia_add(&sc->ifmedia, IFM_ETHER | IFM_1000_T, 0, NULL); 634b418ad5cSPoul-Henning Kamp ifmedia_add(&sc->ifmedia, IFM_ETHER | IFM_1000_T | IFM_HDX, 635167aa833SJulian Elischer 0, NULL); 636167aa833SJulian Elischer if (bootverbose) 6376b9f5c94SGleb Smirnoff device_printf(sc->my_dev, 6386b9f5c94SGleb Smirnoff "1000Mbps full-duplex mode supported\n"); 639167aa833SJulian Elischer ifp->if_baudrate = 1000000000; 640b418ad5cSPoul-Henning Kamp ifmedia_add(&sc->ifmedia, IFM_ETHER | IFM_1000_T | IFM_FDX, 641167aa833SJulian Elischer 0, NULL); 642b418ad5cSPoul-Henning Kamp sc->ifmedia.ifm_media = IFM_ETHER | IFM_1000_T | IFM_FDX; 643167aa833SJulian Elischer } 644167aa833SJulian Elischer #endif 645167aa833SJulian Elischer if (bmsr & PHY_BMSR_CANAUTONEG) { 646167aa833SJulian Elischer if (bootverbose) 6476b9f5c94SGleb Smirnoff device_printf(sc->my_dev, "autoneg supported\n"); 648167aa833SJulian Elischer ifmedia_add(&sc->ifmedia, IFM_ETHER | IFM_AUTO, 0, NULL); 649167aa833SJulian Elischer sc->ifmedia.ifm_media = IFM_ETHER | IFM_AUTO; 650167aa833SJulian Elischer } 651167aa833SJulian Elischer return; 652167aa833SJulian Elischer } 653167aa833SJulian Elischer 654167aa833SJulian Elischer /* 655167aa833SJulian Elischer * Set speed and duplex mode. 656167aa833SJulian Elischer */ 657167aa833SJulian Elischer static void 658167aa833SJulian Elischer my_setmode_mii(struct my_softc * sc, int media) 659167aa833SJulian Elischer { 660167aa833SJulian Elischer u_int16_t bmcr; 661167aa833SJulian Elischer 662ca5fc32dSJohn Baldwin MY_LOCK_ASSERT(sc); 663167aa833SJulian Elischer /* 664167aa833SJulian Elischer * If an autoneg session is in progress, stop it. 665167aa833SJulian Elischer */ 666167aa833SJulian Elischer if (sc->my_autoneg) { 6676b9f5c94SGleb Smirnoff device_printf(sc->my_dev, "canceling autoneg session\n"); 668d4e576c4SJohn Baldwin callout_stop(&sc->my_autoneg_timer); 669d4e576c4SJohn Baldwin sc->my_autoneg = sc->my_want_auto = 0; 670167aa833SJulian Elischer bmcr = my_phy_readreg(sc, PHY_BMCR); 671167aa833SJulian Elischer bmcr &= ~PHY_BMCR_AUTONEGENBL; 672167aa833SJulian Elischer my_phy_writereg(sc, PHY_BMCR, bmcr); 673167aa833SJulian Elischer } 6746b9f5c94SGleb Smirnoff device_printf(sc->my_dev, "selecting MII, "); 675167aa833SJulian Elischer bmcr = my_phy_readreg(sc, PHY_BMCR); 676167aa833SJulian Elischer bmcr &= ~(PHY_BMCR_AUTONEGENBL | PHY_BMCR_SPEEDSEL | PHY_BMCR_1000 | 677167aa833SJulian Elischer PHY_BMCR_DUPLEX | PHY_BMCR_LOOPBK); 6780cde2d13SJulian Elischer 6790cde2d13SJulian Elischer #if 0 /* this version did not support 1000M, */ 680b418ad5cSPoul-Henning Kamp if (IFM_SUBTYPE(media) == IFM_1000_T) { 681167aa833SJulian Elischer printf("1000Mbps/T4, half-duplex\n"); 682167aa833SJulian Elischer bmcr &= ~PHY_BMCR_SPEEDSEL; 683167aa833SJulian Elischer bmcr &= ~PHY_BMCR_DUPLEX; 684167aa833SJulian Elischer bmcr |= PHY_BMCR_1000; 685167aa833SJulian Elischer } 686167aa833SJulian Elischer #endif 687167aa833SJulian Elischer if (IFM_SUBTYPE(media) == IFM_100_T4) { 688167aa833SJulian Elischer printf("100Mbps/T4, half-duplex\n"); 689167aa833SJulian Elischer bmcr |= PHY_BMCR_SPEEDSEL; 690167aa833SJulian Elischer bmcr &= ~PHY_BMCR_DUPLEX; 691167aa833SJulian Elischer } 692167aa833SJulian Elischer if (IFM_SUBTYPE(media) == IFM_100_TX) { 693167aa833SJulian Elischer printf("100Mbps, "); 694167aa833SJulian Elischer bmcr |= PHY_BMCR_SPEEDSEL; 695167aa833SJulian Elischer } 696167aa833SJulian Elischer if (IFM_SUBTYPE(media) == IFM_10_T) { 697167aa833SJulian Elischer printf("10Mbps, "); 698167aa833SJulian Elischer bmcr &= ~PHY_BMCR_SPEEDSEL; 699167aa833SJulian Elischer } 700167aa833SJulian Elischer if ((media & IFM_GMASK) == IFM_FDX) { 701167aa833SJulian Elischer printf("full duplex\n"); 702167aa833SJulian Elischer bmcr |= PHY_BMCR_DUPLEX; 703167aa833SJulian Elischer } else { 704167aa833SJulian Elischer printf("half duplex\n"); 705167aa833SJulian Elischer bmcr &= ~PHY_BMCR_DUPLEX; 706167aa833SJulian Elischer } 707167aa833SJulian Elischer my_phy_writereg(sc, PHY_BMCR, bmcr); 708167aa833SJulian Elischer my_setcfg(sc, bmcr); 709167aa833SJulian Elischer return; 710167aa833SJulian Elischer } 711167aa833SJulian Elischer 712167aa833SJulian Elischer /* 713167aa833SJulian Elischer * The Myson manual states that in order to fiddle with the 'full-duplex' and 714167aa833SJulian Elischer * '100Mbps' bits in the netconfig register, we first have to put the 715167aa833SJulian Elischer * transmit and/or receive logic in the idle state. 716167aa833SJulian Elischer */ 717167aa833SJulian Elischer static void 718167aa833SJulian Elischer my_setcfg(struct my_softc * sc, int bmcr) 719167aa833SJulian Elischer { 720167aa833SJulian Elischer int i, restart = 0; 721167aa833SJulian Elischer 722ca5fc32dSJohn Baldwin MY_LOCK_ASSERT(sc); 723167aa833SJulian Elischer if (CSR_READ_4(sc, MY_TCRRCR) & (MY_TE | MY_RE)) { 724167aa833SJulian Elischer restart = 1; 725167aa833SJulian Elischer MY_CLRBIT(sc, MY_TCRRCR, (MY_TE | MY_RE)); 726167aa833SJulian Elischer for (i = 0; i < MY_TIMEOUT; i++) { 727167aa833SJulian Elischer DELAY(10); 728167aa833SJulian Elischer if (!(CSR_READ_4(sc, MY_TCRRCR) & 729167aa833SJulian Elischer (MY_TXRUN | MY_RXRUN))) 730167aa833SJulian Elischer break; 731167aa833SJulian Elischer } 732167aa833SJulian Elischer if (i == MY_TIMEOUT) 7336b9f5c94SGleb Smirnoff device_printf(sc->my_dev, 73412611131SJohn Baldwin "failed to force tx and rx to idle \n"); 735167aa833SJulian Elischer } 736167aa833SJulian Elischer MY_CLRBIT(sc, MY_TCRRCR, MY_PS1000); 737167aa833SJulian Elischer MY_CLRBIT(sc, MY_TCRRCR, MY_PS10); 738167aa833SJulian Elischer if (bmcr & PHY_BMCR_1000) 739167aa833SJulian Elischer MY_SETBIT(sc, MY_TCRRCR, MY_PS1000); 740167aa833SJulian Elischer else if (!(bmcr & PHY_BMCR_SPEEDSEL)) 741167aa833SJulian Elischer MY_SETBIT(sc, MY_TCRRCR, MY_PS10); 742167aa833SJulian Elischer if (bmcr & PHY_BMCR_DUPLEX) 743167aa833SJulian Elischer MY_SETBIT(sc, MY_TCRRCR, MY_FD); 744167aa833SJulian Elischer else 745167aa833SJulian Elischer MY_CLRBIT(sc, MY_TCRRCR, MY_FD); 746167aa833SJulian Elischer if (restart) 747167aa833SJulian Elischer MY_SETBIT(sc, MY_TCRRCR, MY_TE | MY_RE); 748167aa833SJulian Elischer return; 749167aa833SJulian Elischer } 750167aa833SJulian Elischer 751167aa833SJulian Elischer static void 752167aa833SJulian Elischer my_reset(struct my_softc * sc) 753167aa833SJulian Elischer { 754167aa833SJulian Elischer register int i; 755167aa833SJulian Elischer 756ca5fc32dSJohn Baldwin MY_LOCK_ASSERT(sc); 757167aa833SJulian Elischer MY_SETBIT(sc, MY_BCR, MY_SWR); 758167aa833SJulian Elischer for (i = 0; i < MY_TIMEOUT; i++) { 759167aa833SJulian Elischer DELAY(10); 760167aa833SJulian Elischer if (!(CSR_READ_4(sc, MY_BCR) & MY_SWR)) 761167aa833SJulian Elischer break; 762167aa833SJulian Elischer } 763167aa833SJulian Elischer if (i == MY_TIMEOUT) 7646b9f5c94SGleb Smirnoff device_printf(sc->my_dev, "reset never completed!\n"); 765167aa833SJulian Elischer 766167aa833SJulian Elischer /* Wait a little while for the chip to get its brains in order. */ 767167aa833SJulian Elischer DELAY(1000); 768167aa833SJulian Elischer return; 769167aa833SJulian Elischer } 770167aa833SJulian Elischer 771167aa833SJulian Elischer /* 772167aa833SJulian Elischer * Probe for a Myson chip. Check the PCI vendor and device IDs against our 773167aa833SJulian Elischer * list and return a device name if we find a match. 774167aa833SJulian Elischer */ 775167aa833SJulian Elischer static int 776167aa833SJulian Elischer my_probe(device_t dev) 777167aa833SJulian Elischer { 778167aa833SJulian Elischer struct my_type *t; 779167aa833SJulian Elischer 780167aa833SJulian Elischer t = my_devs; 781167aa833SJulian Elischer while (t->my_name != NULL) { 782167aa833SJulian Elischer if ((pci_get_vendor(dev) == t->my_vid) && 783167aa833SJulian Elischer (pci_get_device(dev) == t->my_did)) { 784167aa833SJulian Elischer device_set_desc(dev, t->my_name); 785167aa833SJulian Elischer my_info_tmp = t; 7866b9907e7SWarner Losh return (BUS_PROBE_DEFAULT); 787167aa833SJulian Elischer } 788167aa833SJulian Elischer t++; 789167aa833SJulian Elischer } 790167aa833SJulian Elischer return (ENXIO); 791167aa833SJulian Elischer } 792167aa833SJulian Elischer 793167aa833SJulian Elischer /* 794167aa833SJulian Elischer * Attach the interface. Allocate softc structures, do ifmedia setup and 795167aa833SJulian Elischer * ethernet/BPF attach. 796167aa833SJulian Elischer */ 797167aa833SJulian Elischer static int 798167aa833SJulian Elischer my_attach(device_t dev) 799167aa833SJulian Elischer { 800ca5fc32dSJohn Baldwin int i; 801167aa833SJulian Elischer u_char eaddr[ETHER_ADDR_LEN]; 802bd295e68SJohn Baldwin u_int32_t iobase; 803167aa833SJulian Elischer struct my_softc *sc; 804167aa833SJulian Elischer struct ifnet *ifp; 805167aa833SJulian Elischer int media = IFM_ETHER | IFM_100_TX | IFM_FDX; 806167aa833SJulian Elischer unsigned int round; 807167aa833SJulian Elischer caddr_t roundptr; 808167aa833SJulian Elischer struct my_type *p; 809167aa833SJulian Elischer u_int16_t phy_vid, phy_did, phy_sts = 0; 81012611131SJohn Baldwin int rid, error = 0; 811167aa833SJulian Elischer 812167aa833SJulian Elischer sc = device_get_softc(dev); 8136b9f5c94SGleb Smirnoff sc->my_dev = dev; 814f269532cSJulian Elischer mtx_init(&sc->my_mtx, device_get_nameunit(dev), MTX_NETWORK_LOCK, 815ca5fc32dSJohn Baldwin MTX_DEF); 816d4e576c4SJohn Baldwin callout_init_mtx(&sc->my_autoneg_timer, &sc->my_mtx, 0); 817d4e576c4SJohn Baldwin callout_init_mtx(&sc->my_watchdog, &sc->my_mtx, 0); 818167aa833SJulian Elischer 819167aa833SJulian Elischer /* 820167aa833SJulian Elischer * Map control/status registers. 821167aa833SJulian Elischer */ 822bd295e68SJohn Baldwin pci_enable_busmaster(dev); 823167aa833SJulian Elischer 824167aa833SJulian Elischer if (my_info_tmp->my_did == MTD800ID) { 825167aa833SJulian Elischer iobase = pci_read_config(dev, MY_PCI_LOIO, 4); 826167aa833SJulian Elischer if (iobase & 0x300) 827167aa833SJulian Elischer MY_USEIOSPACE = 0; 828167aa833SJulian Elischer } 829167aa833SJulian Elischer 830167aa833SJulian Elischer rid = MY_RID; 8315f96beb9SNate Lawson sc->my_res = bus_alloc_resource_any(dev, MY_RES, &rid, RF_ACTIVE); 832167aa833SJulian Elischer 833167aa833SJulian Elischer if (sc->my_res == NULL) { 83412611131SJohn Baldwin device_printf(dev, "couldn't map ports/memory\n"); 835167aa833SJulian Elischer error = ENXIO; 836ca5fc32dSJohn Baldwin goto destroy_mutex; 837167aa833SJulian Elischer } 838167aa833SJulian Elischer sc->my_btag = rman_get_bustag(sc->my_res); 839167aa833SJulian Elischer sc->my_bhandle = rman_get_bushandle(sc->my_res); 840167aa833SJulian Elischer 841167aa833SJulian Elischer rid = 0; 8425f96beb9SNate Lawson sc->my_irq = bus_alloc_resource_any(dev, SYS_RES_IRQ, &rid, 843167aa833SJulian Elischer RF_SHAREABLE | RF_ACTIVE); 844167aa833SJulian Elischer 845167aa833SJulian Elischer if (sc->my_irq == NULL) { 84612611131SJohn Baldwin device_printf(dev, "couldn't map interrupt\n"); 847167aa833SJulian Elischer error = ENXIO; 848ca5fc32dSJohn Baldwin goto release_io; 849167aa833SJulian Elischer } 850167aa833SJulian Elischer 851167aa833SJulian Elischer sc->my_info = my_info_tmp; 852167aa833SJulian Elischer 853167aa833SJulian Elischer /* Reset the adapter. */ 854ca5fc32dSJohn Baldwin MY_LOCK(sc); 855167aa833SJulian Elischer my_reset(sc); 856ca5fc32dSJohn Baldwin MY_UNLOCK(sc); 857167aa833SJulian Elischer 858167aa833SJulian Elischer /* 859167aa833SJulian Elischer * Get station address 860167aa833SJulian Elischer */ 861167aa833SJulian Elischer for (i = 0; i < ETHER_ADDR_LEN; ++i) 862167aa833SJulian Elischer eaddr[i] = CSR_READ_1(sc, MY_PAR0 + i); 863167aa833SJulian Elischer 864167aa833SJulian Elischer sc->my_ldata_ptr = malloc(sizeof(struct my_list_data) + 8, 865167aa833SJulian Elischer M_DEVBUF, M_NOWAIT); 866167aa833SJulian Elischer if (sc->my_ldata_ptr == NULL) { 86712611131SJohn Baldwin device_printf(dev, "no memory for list buffers!\n"); 868167aa833SJulian Elischer error = ENXIO; 869ca5fc32dSJohn Baldwin goto release_irq; 870167aa833SJulian Elischer } 871167aa833SJulian Elischer sc->my_ldata = (struct my_list_data *) sc->my_ldata_ptr; 8722fc606e2SJohn Baldwin round = (uintptr_t)sc->my_ldata_ptr & 0xF; 873167aa833SJulian Elischer roundptr = sc->my_ldata_ptr; 874167aa833SJulian Elischer for (i = 0; i < 8; i++) { 875167aa833SJulian Elischer if (round % 8) { 876167aa833SJulian Elischer round++; 877167aa833SJulian Elischer roundptr++; 878167aa833SJulian Elischer } else 879167aa833SJulian Elischer break; 880167aa833SJulian Elischer } 881167aa833SJulian Elischer sc->my_ldata = (struct my_list_data *) roundptr; 882167aa833SJulian Elischer bzero(sc->my_ldata, sizeof(struct my_list_data)); 883167aa833SJulian Elischer 884fc74a9f9SBrooks Davis ifp = sc->my_ifp = if_alloc(IFT_ETHER); 885fc74a9f9SBrooks Davis if (ifp == NULL) { 886fc74a9f9SBrooks Davis device_printf(dev, "can not if_alloc()\n"); 887fc74a9f9SBrooks Davis error = ENOSPC; 888ca5fc32dSJohn Baldwin goto free_ldata; 889fc74a9f9SBrooks Davis } 890167aa833SJulian Elischer ifp->if_softc = sc; 8919bf40edeSBrooks Davis if_initname(ifp, device_get_name(dev), device_get_unit(dev)); 892167aa833SJulian Elischer ifp->if_flags = IFF_BROADCAST | IFF_SIMPLEX | IFF_MULTICAST; 893167aa833SJulian Elischer ifp->if_ioctl = my_ioctl; 894167aa833SJulian Elischer ifp->if_start = my_start; 895167aa833SJulian Elischer ifp->if_init = my_init; 896167aa833SJulian Elischer ifp->if_baudrate = 10000000; 897e50d35e6SMaxim Sobolev IFQ_SET_MAXLEN(&ifp->if_snd, ifqmaxlen); 898e50d35e6SMaxim Sobolev ifp->if_snd.ifq_drv_maxlen = ifqmaxlen; 8999522f75aSChristian Brueffer IFQ_SET_READY(&ifp->if_snd); 900167aa833SJulian Elischer 901167aa833SJulian Elischer if (sc->my_info->my_did == MTD803ID) 902167aa833SJulian Elischer sc->my_pinfo = my_phys; 903167aa833SJulian Elischer else { 904167aa833SJulian Elischer if (bootverbose) 90512611131SJohn Baldwin device_printf(dev, "probing for a PHY\n"); 906ca5fc32dSJohn Baldwin MY_LOCK(sc); 907167aa833SJulian Elischer for (i = MY_PHYADDR_MIN; i < MY_PHYADDR_MAX + 1; i++) { 908167aa833SJulian Elischer if (bootverbose) 90912611131SJohn Baldwin device_printf(dev, "checking address: %d\n", i); 910167aa833SJulian Elischer sc->my_phy_addr = i; 911167aa833SJulian Elischer phy_sts = my_phy_readreg(sc, PHY_BMSR); 912167aa833SJulian Elischer if ((phy_sts != 0) && (phy_sts != 0xffff)) 913167aa833SJulian Elischer break; 914167aa833SJulian Elischer else 915167aa833SJulian Elischer phy_sts = 0; 916167aa833SJulian Elischer } 917167aa833SJulian Elischer if (phy_sts) { 918167aa833SJulian Elischer phy_vid = my_phy_readreg(sc, PHY_VENID); 919167aa833SJulian Elischer phy_did = my_phy_readreg(sc, PHY_DEVID); 920167aa833SJulian Elischer if (bootverbose) { 92112611131SJohn Baldwin device_printf(dev, "found PHY at address %d, ", 92212611131SJohn Baldwin sc->my_phy_addr); 923167aa833SJulian Elischer printf("vendor id: %x device id: %x\n", 924167aa833SJulian Elischer phy_vid, phy_did); 925167aa833SJulian Elischer } 926167aa833SJulian Elischer p = my_phys; 927167aa833SJulian Elischer while (p->my_vid) { 928167aa833SJulian Elischer if (phy_vid == p->my_vid) { 929167aa833SJulian Elischer sc->my_pinfo = p; 930167aa833SJulian Elischer break; 931167aa833SJulian Elischer } 932167aa833SJulian Elischer p++; 933167aa833SJulian Elischer } 934167aa833SJulian Elischer if (sc->my_pinfo == NULL) 935167aa833SJulian Elischer sc->my_pinfo = &my_phys[PHY_UNKNOWN]; 936167aa833SJulian Elischer if (bootverbose) 93712611131SJohn Baldwin device_printf(dev, "PHY type: %s\n", 93812611131SJohn Baldwin sc->my_pinfo->my_name); 939167aa833SJulian Elischer } else { 940ca5fc32dSJohn Baldwin MY_UNLOCK(sc); 94112611131SJohn Baldwin device_printf(dev, "MII without any phy!\n"); 942167aa833SJulian Elischer error = ENXIO; 943ca5fc32dSJohn Baldwin goto free_if; 944167aa833SJulian Elischer } 945ca5fc32dSJohn Baldwin MY_UNLOCK(sc); 946167aa833SJulian Elischer } 947167aa833SJulian Elischer 948167aa833SJulian Elischer /* Do ifmedia setup. */ 949167aa833SJulian Elischer ifmedia_init(&sc->ifmedia, 0, my_ifmedia_upd, my_ifmedia_sts); 950ca5fc32dSJohn Baldwin MY_LOCK(sc); 951167aa833SJulian Elischer my_getmode_mii(sc); 952167aa833SJulian Elischer my_autoneg_mii(sc, MY_FLAG_FORCEDELAY, 1); 953167aa833SJulian Elischer media = sc->ifmedia.ifm_media; 954167aa833SJulian Elischer my_stop(sc); 955ca5fc32dSJohn Baldwin MY_UNLOCK(sc); 956167aa833SJulian Elischer ifmedia_set(&sc->ifmedia, media); 957167aa833SJulian Elischer 958673d9191SSam Leffler ether_ifattach(ifp, eaddr); 959167aa833SJulian Elischer 960ca5fc32dSJohn Baldwin error = bus_setup_intr(dev, sc->my_irq, INTR_TYPE_NET | INTR_MPSAFE, 961ef544f63SPaolo Pisati NULL, my_intr, sc, &sc->my_intrhand); 962ca5fc32dSJohn Baldwin 963ca5fc32dSJohn Baldwin if (error) { 964ca5fc32dSJohn Baldwin device_printf(dev, "couldn't set up irq\n"); 965ca5fc32dSJohn Baldwin goto detach_if; 966ca5fc32dSJohn Baldwin } 967ca5fc32dSJohn Baldwin 968167aa833SJulian Elischer return (0); 969167aa833SJulian Elischer 970ca5fc32dSJohn Baldwin detach_if: 971ca5fc32dSJohn Baldwin ether_ifdetach(ifp); 972ca5fc32dSJohn Baldwin free_if: 973ca5fc32dSJohn Baldwin if_free(ifp); 974ca5fc32dSJohn Baldwin free_ldata: 975fc74a9f9SBrooks Davis free(sc->my_ldata_ptr, M_DEVBUF); 976ca5fc32dSJohn Baldwin release_irq: 977ca5fc32dSJohn Baldwin bus_release_resource(dev, SYS_RES_IRQ, 0, sc->my_irq); 978ca5fc32dSJohn Baldwin release_io: 979ca5fc32dSJohn Baldwin bus_release_resource(dev, MY_RES, MY_RID, sc->my_res); 980ca5fc32dSJohn Baldwin destroy_mutex: 981ca5fc32dSJohn Baldwin mtx_destroy(&sc->my_mtx); 982167aa833SJulian Elischer return (error); 983167aa833SJulian Elischer } 984167aa833SJulian Elischer 985167aa833SJulian Elischer static int 986167aa833SJulian Elischer my_detach(device_t dev) 987167aa833SJulian Elischer { 988167aa833SJulian Elischer struct my_softc *sc; 989167aa833SJulian Elischer struct ifnet *ifp; 990167aa833SJulian Elischer 991167aa833SJulian Elischer sc = device_get_softc(dev); 992d4e576c4SJohn Baldwin ifp = sc->my_ifp; 993d4e576c4SJohn Baldwin ether_ifdetach(ifp); 994167aa833SJulian Elischer MY_LOCK(sc); 995ca5fc32dSJohn Baldwin my_stop(sc); 996ca5fc32dSJohn Baldwin MY_UNLOCK(sc); 997ca5fc32dSJohn Baldwin bus_teardown_intr(dev, sc->my_irq, sc->my_intrhand); 998d4e576c4SJohn Baldwin callout_drain(&sc->my_watchdog); 999d4e576c4SJohn Baldwin callout_drain(&sc->my_autoneg_timer); 1000ca5fc32dSJohn Baldwin 1001fc74a9f9SBrooks Davis if_free(ifp); 1002ca5fc32dSJohn Baldwin free(sc->my_ldata_ptr, M_DEVBUF); 1003167aa833SJulian Elischer 1004167aa833SJulian Elischer bus_release_resource(dev, SYS_RES_IRQ, 0, sc->my_irq); 1005167aa833SJulian Elischer bus_release_resource(dev, MY_RES, MY_RID, sc->my_res); 1006167aa833SJulian Elischer mtx_destroy(&sc->my_mtx); 1007167aa833SJulian Elischer return (0); 1008167aa833SJulian Elischer } 1009167aa833SJulian Elischer 1010167aa833SJulian Elischer 1011167aa833SJulian Elischer /* 1012167aa833SJulian Elischer * Initialize the transmit descriptors. 1013167aa833SJulian Elischer */ 1014167aa833SJulian Elischer static int 1015167aa833SJulian Elischer my_list_tx_init(struct my_softc * sc) 1016167aa833SJulian Elischer { 1017167aa833SJulian Elischer struct my_chain_data *cd; 1018167aa833SJulian Elischer struct my_list_data *ld; 1019167aa833SJulian Elischer int i; 1020167aa833SJulian Elischer 1021ca5fc32dSJohn Baldwin MY_LOCK_ASSERT(sc); 1022167aa833SJulian Elischer cd = &sc->my_cdata; 1023167aa833SJulian Elischer ld = sc->my_ldata; 1024167aa833SJulian Elischer for (i = 0; i < MY_TX_LIST_CNT; i++) { 1025167aa833SJulian Elischer cd->my_tx_chain[i].my_ptr = &ld->my_tx_list[i]; 1026167aa833SJulian Elischer if (i == (MY_TX_LIST_CNT - 1)) 1027167aa833SJulian Elischer cd->my_tx_chain[i].my_nextdesc = &cd->my_tx_chain[0]; 1028167aa833SJulian Elischer else 1029167aa833SJulian Elischer cd->my_tx_chain[i].my_nextdesc = 1030167aa833SJulian Elischer &cd->my_tx_chain[i + 1]; 1031167aa833SJulian Elischer } 1032167aa833SJulian Elischer cd->my_tx_free = &cd->my_tx_chain[0]; 1033167aa833SJulian Elischer cd->my_tx_tail = cd->my_tx_head = NULL; 1034167aa833SJulian Elischer return (0); 1035167aa833SJulian Elischer } 1036167aa833SJulian Elischer 1037167aa833SJulian Elischer /* 1038167aa833SJulian Elischer * Initialize the RX descriptors and allocate mbufs for them. Note that we 1039167aa833SJulian Elischer * arrange the descriptors in a closed ring, so that the last descriptor 1040167aa833SJulian Elischer * points back to the first. 1041167aa833SJulian Elischer */ 1042167aa833SJulian Elischer static int 1043167aa833SJulian Elischer my_list_rx_init(struct my_softc * sc) 1044167aa833SJulian Elischer { 1045167aa833SJulian Elischer struct my_chain_data *cd; 1046167aa833SJulian Elischer struct my_list_data *ld; 1047167aa833SJulian Elischer int i; 1048167aa833SJulian Elischer 1049ca5fc32dSJohn Baldwin MY_LOCK_ASSERT(sc); 1050167aa833SJulian Elischer cd = &sc->my_cdata; 1051167aa833SJulian Elischer ld = sc->my_ldata; 1052167aa833SJulian Elischer for (i = 0; i < MY_RX_LIST_CNT; i++) { 1053167aa833SJulian Elischer cd->my_rx_chain[i].my_ptr = 1054167aa833SJulian Elischer (struct my_desc *) & ld->my_rx_list[i]; 1055a86d27acSJulian Elischer if (my_newbuf(sc, &cd->my_rx_chain[i]) == ENOBUFS) { 1056a86d27acSJulian Elischer MY_UNLOCK(sc); 1057167aa833SJulian Elischer return (ENOBUFS); 1058a86d27acSJulian Elischer } 1059167aa833SJulian Elischer if (i == (MY_RX_LIST_CNT - 1)) { 1060167aa833SJulian Elischer cd->my_rx_chain[i].my_nextdesc = &cd->my_rx_chain[0]; 1061167aa833SJulian Elischer ld->my_rx_list[i].my_next = vtophys(&ld->my_rx_list[0]); 1062167aa833SJulian Elischer } else { 1063167aa833SJulian Elischer cd->my_rx_chain[i].my_nextdesc = 1064167aa833SJulian Elischer &cd->my_rx_chain[i + 1]; 1065167aa833SJulian Elischer ld->my_rx_list[i].my_next = 1066167aa833SJulian Elischer vtophys(&ld->my_rx_list[i + 1]); 1067167aa833SJulian Elischer } 1068167aa833SJulian Elischer } 1069167aa833SJulian Elischer cd->my_rx_head = &cd->my_rx_chain[0]; 1070167aa833SJulian Elischer return (0); 1071167aa833SJulian Elischer } 1072167aa833SJulian Elischer 1073167aa833SJulian Elischer /* 1074167aa833SJulian Elischer * Initialize an RX descriptor and attach an MBUF cluster. 1075167aa833SJulian Elischer */ 1076167aa833SJulian Elischer static int 1077167aa833SJulian Elischer my_newbuf(struct my_softc * sc, struct my_chain_onefrag * c) 1078167aa833SJulian Elischer { 1079167aa833SJulian Elischer struct mbuf *m_new = NULL; 1080167aa833SJulian Elischer 1081ca5fc32dSJohn Baldwin MY_LOCK_ASSERT(sc); 1082c6499eccSGleb Smirnoff MGETHDR(m_new, M_NOWAIT, MT_DATA); 1083167aa833SJulian Elischer if (m_new == NULL) { 10846b9f5c94SGleb Smirnoff device_printf(sc->my_dev, 108512611131SJohn Baldwin "no memory for rx list -- packet dropped!\n"); 1086167aa833SJulian Elischer return (ENOBUFS); 1087167aa833SJulian Elischer } 1088c6499eccSGleb Smirnoff MCLGET(m_new, M_NOWAIT); 1089167aa833SJulian Elischer if (!(m_new->m_flags & M_EXT)) { 10906b9f5c94SGleb Smirnoff device_printf(sc->my_dev, 109112611131SJohn Baldwin "no memory for rx list -- packet dropped!\n"); 1092167aa833SJulian Elischer m_freem(m_new); 1093167aa833SJulian Elischer return (ENOBUFS); 1094167aa833SJulian Elischer } 1095167aa833SJulian Elischer c->my_mbuf = m_new; 1096167aa833SJulian Elischer c->my_ptr->my_data = vtophys(mtod(m_new, caddr_t)); 1097167aa833SJulian Elischer c->my_ptr->my_ctl = (MCLBYTES - 1) << MY_RBSShift; 1098167aa833SJulian Elischer c->my_ptr->my_status = MY_OWNByNIC; 1099167aa833SJulian Elischer return (0); 1100167aa833SJulian Elischer } 1101167aa833SJulian Elischer 1102167aa833SJulian Elischer /* 1103167aa833SJulian Elischer * A frame has been uploaded: pass the resulting mbuf chain up to the higher 1104167aa833SJulian Elischer * level protocols. 1105167aa833SJulian Elischer */ 1106167aa833SJulian Elischer static void 1107167aa833SJulian Elischer my_rxeof(struct my_softc * sc) 1108167aa833SJulian Elischer { 1109167aa833SJulian Elischer struct ether_header *eh; 1110167aa833SJulian Elischer struct mbuf *m; 1111167aa833SJulian Elischer struct ifnet *ifp; 1112167aa833SJulian Elischer struct my_chain_onefrag *cur_rx; 1113167aa833SJulian Elischer int total_len = 0; 1114167aa833SJulian Elischer u_int32_t rxstat; 1115167aa833SJulian Elischer 1116ca5fc32dSJohn Baldwin MY_LOCK_ASSERT(sc); 1117fc74a9f9SBrooks Davis ifp = sc->my_ifp; 1118167aa833SJulian Elischer while (!((rxstat = sc->my_cdata.my_rx_head->my_ptr->my_status) 1119167aa833SJulian Elischer & MY_OWNByNIC)) { 1120167aa833SJulian Elischer cur_rx = sc->my_cdata.my_rx_head; 1121167aa833SJulian Elischer sc->my_cdata.my_rx_head = cur_rx->my_nextdesc; 1122167aa833SJulian Elischer 1123167aa833SJulian Elischer if (rxstat & MY_ES) { /* error summary: give up this rx pkt */ 1124dde47b55SGleb Smirnoff if_inc_counter(ifp, IFCOUNTER_IERRORS, 1); 1125167aa833SJulian Elischer cur_rx->my_ptr->my_status = MY_OWNByNIC; 1126167aa833SJulian Elischer continue; 1127167aa833SJulian Elischer } 1128167aa833SJulian Elischer /* No errors; receive the packet. */ 1129167aa833SJulian Elischer total_len = (rxstat & MY_FLNGMASK) >> MY_FLNGShift; 1130167aa833SJulian Elischer total_len -= ETHER_CRC_LEN; 1131167aa833SJulian Elischer 1132167aa833SJulian Elischer if (total_len < MINCLSIZE) { 1133167aa833SJulian Elischer m = m_devget(mtod(cur_rx->my_mbuf, char *), 1134167aa833SJulian Elischer total_len, 0, ifp, NULL); 1135167aa833SJulian Elischer cur_rx->my_ptr->my_status = MY_OWNByNIC; 1136167aa833SJulian Elischer if (m == NULL) { 1137dde47b55SGleb Smirnoff if_inc_counter(ifp, IFCOUNTER_IERRORS, 1); 1138167aa833SJulian Elischer continue; 1139167aa833SJulian Elischer } 1140167aa833SJulian Elischer } else { 1141167aa833SJulian Elischer m = cur_rx->my_mbuf; 1142167aa833SJulian Elischer /* 1143167aa833SJulian Elischer * Try to conjure up a new mbuf cluster. If that 1144167aa833SJulian Elischer * fails, it means we have an out of memory condition 1145167aa833SJulian Elischer * and should leave the buffer in place and continue. 1146167aa833SJulian Elischer * This will result in a lost packet, but there's 1147167aa833SJulian Elischer * little else we can do in this situation. 1148167aa833SJulian Elischer */ 1149167aa833SJulian Elischer if (my_newbuf(sc, cur_rx) == ENOBUFS) { 1150dde47b55SGleb Smirnoff if_inc_counter(ifp, IFCOUNTER_IERRORS, 1); 1151167aa833SJulian Elischer cur_rx->my_ptr->my_status = MY_OWNByNIC; 1152167aa833SJulian Elischer continue; 1153167aa833SJulian Elischer } 1154167aa833SJulian Elischer m->m_pkthdr.rcvif = ifp; 1155167aa833SJulian Elischer m->m_pkthdr.len = m->m_len = total_len; 1156167aa833SJulian Elischer } 1157dde47b55SGleb Smirnoff if_inc_counter(ifp, IFCOUNTER_IPACKETS, 1); 1158167aa833SJulian Elischer eh = mtod(m, struct ether_header *); 1159167aa833SJulian Elischer #if NBPFILTER > 0 1160167aa833SJulian Elischer /* 1161167aa833SJulian Elischer * Handle BPF listeners. Let the BPF user see the packet, but 1162167aa833SJulian Elischer * don't pass it up to the ether_input() layer unless it's a 1163167aa833SJulian Elischer * broadcast packet, multicast packet, matches our ethernet 1164167aa833SJulian Elischer * address or the interface is in promiscuous mode. 1165167aa833SJulian Elischer */ 11660dea849aSJohn Baldwin if (bpf_peers_present(ifp->if_bpf)) { 116755834910SJohn Baldwin bpf_mtap(ifp->if_bpf, m); 1168167aa833SJulian Elischer if (ifp->if_flags & IFF_PROMISC && 11694a0d6638SRuslan Ermilov (bcmp(eh->ether_dhost, IF_LLADDR(sc->my_ifp), 1170167aa833SJulian Elischer ETHER_ADDR_LEN) && 1171167aa833SJulian Elischer (eh->ether_dhost[0] & 1) == 0)) { 1172167aa833SJulian Elischer m_freem(m); 1173167aa833SJulian Elischer continue; 1174167aa833SJulian Elischer } 1175167aa833SJulian Elischer } 1176167aa833SJulian Elischer #endif 11775120abbfSSam Leffler MY_UNLOCK(sc); 1178673d9191SSam Leffler (*ifp->if_input)(ifp, m); 11795120abbfSSam Leffler MY_LOCK(sc); 1180167aa833SJulian Elischer } 1181167aa833SJulian Elischer return; 1182167aa833SJulian Elischer } 1183167aa833SJulian Elischer 1184167aa833SJulian Elischer 1185167aa833SJulian Elischer /* 1186167aa833SJulian Elischer * A frame was downloaded to the chip. It's safe for us to clean up the list 1187167aa833SJulian Elischer * buffers. 1188167aa833SJulian Elischer */ 1189167aa833SJulian Elischer static void 1190167aa833SJulian Elischer my_txeof(struct my_softc * sc) 1191167aa833SJulian Elischer { 1192167aa833SJulian Elischer struct my_chain *cur_tx; 1193167aa833SJulian Elischer struct ifnet *ifp; 1194167aa833SJulian Elischer 1195ca5fc32dSJohn Baldwin MY_LOCK_ASSERT(sc); 1196fc74a9f9SBrooks Davis ifp = sc->my_ifp; 1197167aa833SJulian Elischer /* Clear the timeout timer. */ 1198d4e576c4SJohn Baldwin sc->my_timer = 0; 11998ac00c27SJulian Elischer if (sc->my_cdata.my_tx_head == NULL) { 1200167aa833SJulian Elischer return; 12018ac00c27SJulian Elischer } 1202167aa833SJulian Elischer /* 1203167aa833SJulian Elischer * Go through our tx list and free mbufs for those frames that have 1204167aa833SJulian Elischer * been transmitted. 1205167aa833SJulian Elischer */ 1206167aa833SJulian Elischer while (sc->my_cdata.my_tx_head->my_mbuf != NULL) { 1207167aa833SJulian Elischer u_int32_t txstat; 1208167aa833SJulian Elischer 1209167aa833SJulian Elischer cur_tx = sc->my_cdata.my_tx_head; 1210167aa833SJulian Elischer txstat = MY_TXSTATUS(cur_tx); 1211167aa833SJulian Elischer if ((txstat & MY_OWNByNIC) || txstat == MY_UNSENT) 1212167aa833SJulian Elischer break; 1213167aa833SJulian Elischer if (!(CSR_READ_4(sc, MY_TCRRCR) & MY_Enhanced)) { 1214167aa833SJulian Elischer if (txstat & MY_TXERR) { 1215dde47b55SGleb Smirnoff if_inc_counter(ifp, IFCOUNTER_OERRORS, 1); 1216167aa833SJulian Elischer if (txstat & MY_EC) /* excessive collision */ 1217dde47b55SGleb Smirnoff if_inc_counter(ifp, IFCOUNTER_COLLISIONS, 1); 1218167aa833SJulian Elischer if (txstat & MY_LC) /* late collision */ 1219dde47b55SGleb Smirnoff if_inc_counter(ifp, IFCOUNTER_COLLISIONS, 1); 1220167aa833SJulian Elischer } 1221dde47b55SGleb Smirnoff if_inc_counter(ifp, IFCOUNTER_COLLISIONS, 1222dde47b55SGleb Smirnoff (txstat & MY_NCRMASK) >> MY_NCRShift); 1223167aa833SJulian Elischer } 1224dde47b55SGleb Smirnoff if_inc_counter(ifp, IFCOUNTER_OPACKETS, 1); 1225167aa833SJulian Elischer m_freem(cur_tx->my_mbuf); 1226167aa833SJulian Elischer cur_tx->my_mbuf = NULL; 1227167aa833SJulian Elischer if (sc->my_cdata.my_tx_head == sc->my_cdata.my_tx_tail) { 1228167aa833SJulian Elischer sc->my_cdata.my_tx_head = NULL; 1229167aa833SJulian Elischer sc->my_cdata.my_tx_tail = NULL; 1230167aa833SJulian Elischer break; 1231167aa833SJulian Elischer } 1232167aa833SJulian Elischer sc->my_cdata.my_tx_head = cur_tx->my_nextdesc; 1233167aa833SJulian Elischer } 1234167aa833SJulian Elischer if (CSR_READ_4(sc, MY_TCRRCR) & MY_Enhanced) { 1235dde47b55SGleb Smirnoff if_inc_counter(ifp, IFCOUNTER_COLLISIONS, (CSR_READ_4(sc, MY_TSR) & MY_NCRMask)); 1236167aa833SJulian Elischer } 1237167aa833SJulian Elischer return; 1238167aa833SJulian Elischer } 1239167aa833SJulian Elischer 1240167aa833SJulian Elischer /* 1241167aa833SJulian Elischer * TX 'end of channel' interrupt handler. 1242167aa833SJulian Elischer */ 1243167aa833SJulian Elischer static void 1244167aa833SJulian Elischer my_txeoc(struct my_softc * sc) 1245167aa833SJulian Elischer { 1246167aa833SJulian Elischer struct ifnet *ifp; 1247167aa833SJulian Elischer 1248ca5fc32dSJohn Baldwin MY_LOCK_ASSERT(sc); 1249fc74a9f9SBrooks Davis ifp = sc->my_ifp; 1250d4e576c4SJohn Baldwin sc->my_timer = 0; 1251167aa833SJulian Elischer if (sc->my_cdata.my_tx_head == NULL) { 125213f4c340SRobert Watson ifp->if_drv_flags &= ~IFF_DRV_OACTIVE; 1253167aa833SJulian Elischer sc->my_cdata.my_tx_tail = NULL; 1254167aa833SJulian Elischer if (sc->my_want_auto) 1255167aa833SJulian Elischer my_autoneg_mii(sc, MY_FLAG_SCHEDDELAY, 1); 1256167aa833SJulian Elischer } else { 1257167aa833SJulian Elischer if (MY_TXOWN(sc->my_cdata.my_tx_head) == MY_UNSENT) { 1258167aa833SJulian Elischer MY_TXOWN(sc->my_cdata.my_tx_head) = MY_OWNByNIC; 1259d4e576c4SJohn Baldwin sc->my_timer = 5; 1260167aa833SJulian Elischer CSR_WRITE_4(sc, MY_TXPDR, 0xFFFFFFFF); 1261167aa833SJulian Elischer } 1262167aa833SJulian Elischer } 1263167aa833SJulian Elischer return; 1264167aa833SJulian Elischer } 1265167aa833SJulian Elischer 1266167aa833SJulian Elischer static void 1267167aa833SJulian Elischer my_intr(void *arg) 1268167aa833SJulian Elischer { 1269167aa833SJulian Elischer struct my_softc *sc; 1270167aa833SJulian Elischer struct ifnet *ifp; 1271167aa833SJulian Elischer u_int32_t status; 1272167aa833SJulian Elischer 1273167aa833SJulian Elischer sc = arg; 1274167aa833SJulian Elischer MY_LOCK(sc); 1275fc74a9f9SBrooks Davis ifp = sc->my_ifp; 1276167aa833SJulian Elischer if (!(ifp->if_flags & IFF_UP)) { 1277167aa833SJulian Elischer MY_UNLOCK(sc); 1278167aa833SJulian Elischer return; 1279167aa833SJulian Elischer } 1280167aa833SJulian Elischer /* Disable interrupts. */ 1281167aa833SJulian Elischer CSR_WRITE_4(sc, MY_IMR, 0x00000000); 1282167aa833SJulian Elischer 1283167aa833SJulian Elischer for (;;) { 1284167aa833SJulian Elischer status = CSR_READ_4(sc, MY_ISR); 1285167aa833SJulian Elischer status &= MY_INTRS; 1286167aa833SJulian Elischer if (status) 1287167aa833SJulian Elischer CSR_WRITE_4(sc, MY_ISR, status); 1288167aa833SJulian Elischer else 1289167aa833SJulian Elischer break; 1290167aa833SJulian Elischer 1291167aa833SJulian Elischer if (status & MY_RI) /* receive interrupt */ 1292167aa833SJulian Elischer my_rxeof(sc); 1293167aa833SJulian Elischer 1294167aa833SJulian Elischer if ((status & MY_RBU) || (status & MY_RxErr)) { 1295167aa833SJulian Elischer /* rx buffer unavailable or rx error */ 1296dde47b55SGleb Smirnoff if_inc_counter(ifp, IFCOUNTER_IERRORS, 1); 1297167aa833SJulian Elischer #ifdef foo 1298167aa833SJulian Elischer my_stop(sc); 1299167aa833SJulian Elischer my_reset(sc); 1300ca5fc32dSJohn Baldwin my_init_locked(sc); 1301167aa833SJulian Elischer #endif 1302167aa833SJulian Elischer } 1303167aa833SJulian Elischer if (status & MY_TI) /* tx interrupt */ 1304167aa833SJulian Elischer my_txeof(sc); 1305167aa833SJulian Elischer if (status & MY_ETI) /* tx early interrupt */ 1306167aa833SJulian Elischer my_txeof(sc); 1307167aa833SJulian Elischer if (status & MY_TBU) /* tx buffer unavailable */ 1308167aa833SJulian Elischer my_txeoc(sc); 13090cde2d13SJulian Elischer 13100cde2d13SJulian Elischer #if 0 /* 90/1/18 delete */ 13110cde2d13SJulian Elischer if (status & MY_FBE) { 13120cde2d13SJulian Elischer my_reset(sc); 1313ca5fc32dSJohn Baldwin my_init_locked(sc); 13140cde2d13SJulian Elischer } 13150cde2d13SJulian Elischer #endif 13160cde2d13SJulian Elischer 1317167aa833SJulian Elischer } 1318167aa833SJulian Elischer 1319167aa833SJulian Elischer /* Re-enable interrupts. */ 1320167aa833SJulian Elischer CSR_WRITE_4(sc, MY_IMR, MY_INTRS); 13219522f75aSChristian Brueffer if (!IFQ_DRV_IS_EMPTY(&ifp->if_snd)) 1322ca5fc32dSJohn Baldwin my_start_locked(ifp); 1323167aa833SJulian Elischer MY_UNLOCK(sc); 1324167aa833SJulian Elischer return; 1325167aa833SJulian Elischer } 1326167aa833SJulian Elischer 1327167aa833SJulian Elischer /* 1328167aa833SJulian Elischer * Encapsulate an mbuf chain in a descriptor by coupling the mbuf data 1329167aa833SJulian Elischer * pointers to the fragment pointers. 1330167aa833SJulian Elischer */ 1331167aa833SJulian Elischer static int 1332167aa833SJulian Elischer my_encap(struct my_softc * sc, struct my_chain * c, struct mbuf * m_head) 1333167aa833SJulian Elischer { 1334167aa833SJulian Elischer struct my_desc *f = NULL; 1335167aa833SJulian Elischer int total_len; 1336167aa833SJulian Elischer struct mbuf *m, *m_new = NULL; 1337167aa833SJulian Elischer 1338ca5fc32dSJohn Baldwin MY_LOCK_ASSERT(sc); 1339167aa833SJulian Elischer /* calculate the total tx pkt length */ 1340167aa833SJulian Elischer total_len = 0; 1341167aa833SJulian Elischer for (m = m_head; m != NULL; m = m->m_next) 1342167aa833SJulian Elischer total_len += m->m_len; 1343167aa833SJulian Elischer /* 1344167aa833SJulian Elischer * Start packing the mbufs in this chain into the fragment pointers. 1345167aa833SJulian Elischer * Stop when we run out of fragments or hit the end of the mbuf 1346167aa833SJulian Elischer * chain. 1347167aa833SJulian Elischer */ 1348167aa833SJulian Elischer m = m_head; 1349c6499eccSGleb Smirnoff MGETHDR(m_new, M_NOWAIT, MT_DATA); 1350167aa833SJulian Elischer if (m_new == NULL) { 13516b9f5c94SGleb Smirnoff device_printf(sc->my_dev, "no memory for tx list"); 1352167aa833SJulian Elischer return (1); 1353167aa833SJulian Elischer } 1354167aa833SJulian Elischer if (m_head->m_pkthdr.len > MHLEN) { 1355c6499eccSGleb Smirnoff MCLGET(m_new, M_NOWAIT); 1356167aa833SJulian Elischer if (!(m_new->m_flags & M_EXT)) { 1357167aa833SJulian Elischer m_freem(m_new); 13586b9f5c94SGleb Smirnoff device_printf(sc->my_dev, "no memory for tx list"); 1359167aa833SJulian Elischer return (1); 1360167aa833SJulian Elischer } 1361167aa833SJulian Elischer } 1362167aa833SJulian Elischer m_copydata(m_head, 0, m_head->m_pkthdr.len, mtod(m_new, caddr_t)); 1363167aa833SJulian Elischer m_new->m_pkthdr.len = m_new->m_len = m_head->m_pkthdr.len; 1364167aa833SJulian Elischer m_freem(m_head); 1365167aa833SJulian Elischer m_head = m_new; 1366167aa833SJulian Elischer f = &c->my_ptr->my_frag[0]; 1367167aa833SJulian Elischer f->my_status = 0; 1368167aa833SJulian Elischer f->my_data = vtophys(mtod(m_new, caddr_t)); 1369167aa833SJulian Elischer total_len = m_new->m_len; 1370167aa833SJulian Elischer f->my_ctl = MY_TXFD | MY_TXLD | MY_CRCEnable | MY_PADEnable; 1371167aa833SJulian Elischer f->my_ctl |= total_len << MY_PKTShift; /* pkt size */ 1372167aa833SJulian Elischer f->my_ctl |= total_len; /* buffer size */ 13732cc8ce3cSJulian Elischer /* 89/12/29 add, for mtd891 *//* [ 89? ] */ 1374167aa833SJulian Elischer if (sc->my_info->my_did == MTD891ID) 1375167aa833SJulian Elischer f->my_ctl |= MY_ETIControl | MY_RetryTxLC; 1376167aa833SJulian Elischer c->my_mbuf = m_head; 1377167aa833SJulian Elischer c->my_lastdesc = 0; 1378167aa833SJulian Elischer MY_TXNEXT(c) = vtophys(&c->my_nextdesc->my_ptr->my_frag[0]); 1379167aa833SJulian Elischer return (0); 1380167aa833SJulian Elischer } 1381167aa833SJulian Elischer 1382167aa833SJulian Elischer /* 1383167aa833SJulian Elischer * Main transmit routine. To avoid having to do mbuf copies, we put pointers 1384167aa833SJulian Elischer * to the mbuf data regions directly in the transmit lists. We also save a 1385167aa833SJulian Elischer * copy of the pointers since the transmit list fragment pointers are 1386167aa833SJulian Elischer * physical addresses. 1387167aa833SJulian Elischer */ 1388167aa833SJulian Elischer static void 1389167aa833SJulian Elischer my_start(struct ifnet * ifp) 1390167aa833SJulian Elischer { 1391167aa833SJulian Elischer struct my_softc *sc; 1392ca5fc32dSJohn Baldwin 1393ca5fc32dSJohn Baldwin sc = ifp->if_softc; 1394ca5fc32dSJohn Baldwin MY_LOCK(sc); 1395ca5fc32dSJohn Baldwin my_start_locked(ifp); 1396ca5fc32dSJohn Baldwin MY_UNLOCK(sc); 1397ca5fc32dSJohn Baldwin } 1398ca5fc32dSJohn Baldwin 1399ca5fc32dSJohn Baldwin static void 1400ca5fc32dSJohn Baldwin my_start_locked(struct ifnet * ifp) 1401ca5fc32dSJohn Baldwin { 1402ca5fc32dSJohn Baldwin struct my_softc *sc; 1403167aa833SJulian Elischer struct mbuf *m_head = NULL; 1404167aa833SJulian Elischer struct my_chain *cur_tx = NULL, *start_tx; 1405167aa833SJulian Elischer 1406167aa833SJulian Elischer sc = ifp->if_softc; 1407ca5fc32dSJohn Baldwin MY_LOCK_ASSERT(sc); 1408167aa833SJulian Elischer if (sc->my_autoneg) { 1409167aa833SJulian Elischer sc->my_tx_pend = 1; 1410167aa833SJulian Elischer return; 1411167aa833SJulian Elischer } 1412167aa833SJulian Elischer /* 1413167aa833SJulian Elischer * Check for an available queue slot. If there are none, punt. 1414167aa833SJulian Elischer */ 1415167aa833SJulian Elischer if (sc->my_cdata.my_tx_free->my_mbuf != NULL) { 141613f4c340SRobert Watson ifp->if_drv_flags |= IFF_DRV_OACTIVE; 1417167aa833SJulian Elischer return; 1418167aa833SJulian Elischer } 1419167aa833SJulian Elischer start_tx = sc->my_cdata.my_tx_free; 1420167aa833SJulian Elischer while (sc->my_cdata.my_tx_free->my_mbuf == NULL) { 14219522f75aSChristian Brueffer IFQ_DRV_DEQUEUE(&ifp->if_snd, m_head); 1422167aa833SJulian Elischer if (m_head == NULL) 1423167aa833SJulian Elischer break; 1424167aa833SJulian Elischer 1425167aa833SJulian Elischer /* Pick a descriptor off the free list. */ 1426167aa833SJulian Elischer cur_tx = sc->my_cdata.my_tx_free; 1427167aa833SJulian Elischer sc->my_cdata.my_tx_free = cur_tx->my_nextdesc; 1428167aa833SJulian Elischer 1429167aa833SJulian Elischer /* Pack the data into the descriptor. */ 1430167aa833SJulian Elischer my_encap(sc, cur_tx, m_head); 1431167aa833SJulian Elischer 1432167aa833SJulian Elischer if (cur_tx != start_tx) 1433167aa833SJulian Elischer MY_TXOWN(cur_tx) = MY_OWNByNIC; 1434167aa833SJulian Elischer #if NBPFILTER > 0 1435167aa833SJulian Elischer /* 1436167aa833SJulian Elischer * If there's a BPF listener, bounce a copy of this frame to 1437167aa833SJulian Elischer * him. 1438167aa833SJulian Elischer */ 1439673d9191SSam Leffler BPF_MTAP(ifp, cur_tx->my_mbuf); 1440167aa833SJulian Elischer #endif 1441167aa833SJulian Elischer } 1442167aa833SJulian Elischer /* 1443167aa833SJulian Elischer * If there are no packets queued, bail. 1444167aa833SJulian Elischer */ 1445167aa833SJulian Elischer if (cur_tx == NULL) { 1446167aa833SJulian Elischer return; 1447167aa833SJulian Elischer } 1448167aa833SJulian Elischer /* 1449167aa833SJulian Elischer * Place the request for the upload interrupt in the last descriptor 1450167aa833SJulian Elischer * in the chain. This way, if we're chaining several packets at once, 1451976b0106SKevin Lo * we'll only get an interrupt once for the whole chain rather than 1452167aa833SJulian Elischer * once for each packet. 1453167aa833SJulian Elischer */ 1454167aa833SJulian Elischer MY_TXCTL(cur_tx) |= MY_TXIC; 1455167aa833SJulian Elischer cur_tx->my_ptr->my_frag[0].my_ctl |= MY_TXIC; 1456167aa833SJulian Elischer sc->my_cdata.my_tx_tail = cur_tx; 1457167aa833SJulian Elischer if (sc->my_cdata.my_tx_head == NULL) 1458167aa833SJulian Elischer sc->my_cdata.my_tx_head = start_tx; 1459167aa833SJulian Elischer MY_TXOWN(start_tx) = MY_OWNByNIC; 1460167aa833SJulian Elischer CSR_WRITE_4(sc, MY_TXPDR, 0xFFFFFFFF); /* tx polling demand */ 1461167aa833SJulian Elischer 1462167aa833SJulian Elischer /* 1463167aa833SJulian Elischer * Set a timeout in case the chip goes out to lunch. 1464167aa833SJulian Elischer */ 1465d4e576c4SJohn Baldwin sc->my_timer = 5; 1466167aa833SJulian Elischer return; 1467167aa833SJulian Elischer } 1468167aa833SJulian Elischer 1469167aa833SJulian Elischer static void 1470167aa833SJulian Elischer my_init(void *xsc) 1471167aa833SJulian Elischer { 1472167aa833SJulian Elischer struct my_softc *sc = xsc; 1473167aa833SJulian Elischer 1474167aa833SJulian Elischer MY_LOCK(sc); 1475ca5fc32dSJohn Baldwin my_init_locked(sc); 1476167aa833SJulian Elischer MY_UNLOCK(sc); 1477ca5fc32dSJohn Baldwin } 1478ca5fc32dSJohn Baldwin 1479ca5fc32dSJohn Baldwin static void 1480ca5fc32dSJohn Baldwin my_init_locked(struct my_softc *sc) 1481ca5fc32dSJohn Baldwin { 1482ca5fc32dSJohn Baldwin struct ifnet *ifp = sc->my_ifp; 1483ca5fc32dSJohn Baldwin u_int16_t phy_bmcr = 0; 1484ca5fc32dSJohn Baldwin 1485ca5fc32dSJohn Baldwin MY_LOCK_ASSERT(sc); 1486ca5fc32dSJohn Baldwin if (sc->my_autoneg) { 1487167aa833SJulian Elischer return; 1488167aa833SJulian Elischer } 1489167aa833SJulian Elischer if (sc->my_pinfo != NULL) 1490167aa833SJulian Elischer phy_bmcr = my_phy_readreg(sc, PHY_BMCR); 1491167aa833SJulian Elischer /* 1492167aa833SJulian Elischer * Cancel pending I/O and free all RX/TX buffers. 1493167aa833SJulian Elischer */ 1494167aa833SJulian Elischer my_stop(sc); 1495167aa833SJulian Elischer my_reset(sc); 1496167aa833SJulian Elischer 1497167aa833SJulian Elischer /* 1498167aa833SJulian Elischer * Set cache alignment and burst length. 1499167aa833SJulian Elischer */ 15000cde2d13SJulian Elischer #if 0 /* 89/9/1 modify, */ 15010cde2d13SJulian Elischer CSR_WRITE_4(sc, MY_BCR, MY_RPBLE512); 15020cde2d13SJulian Elischer CSR_WRITE_4(sc, MY_TCRRCR, MY_TFTSF); 15030cde2d13SJulian Elischer #endif 1504167aa833SJulian Elischer CSR_WRITE_4(sc, MY_BCR, MY_PBL8); 1505167aa833SJulian Elischer CSR_WRITE_4(sc, MY_TCRRCR, MY_TFTSF | MY_RBLEN | MY_RPBLE512); 1506167aa833SJulian Elischer /* 1507167aa833SJulian Elischer * 89/12/29 add, for mtd891, 1508167aa833SJulian Elischer */ 1509167aa833SJulian Elischer if (sc->my_info->my_did == MTD891ID) { 1510167aa833SJulian Elischer MY_SETBIT(sc, MY_BCR, MY_PROG); 1511167aa833SJulian Elischer MY_SETBIT(sc, MY_TCRRCR, MY_Enhanced); 1512167aa833SJulian Elischer } 1513167aa833SJulian Elischer my_setcfg(sc, phy_bmcr); 1514167aa833SJulian Elischer /* Init circular RX list. */ 1515167aa833SJulian Elischer if (my_list_rx_init(sc) == ENOBUFS) { 15166b9f5c94SGleb Smirnoff device_printf(sc->my_dev, "init failed: no memory for rx buffers\n"); 1517167aa833SJulian Elischer my_stop(sc); 1518167aa833SJulian Elischer return; 1519167aa833SJulian Elischer } 1520167aa833SJulian Elischer /* Init TX descriptors. */ 1521167aa833SJulian Elischer my_list_tx_init(sc); 1522167aa833SJulian Elischer 1523167aa833SJulian Elischer /* If we want promiscuous mode, set the allframes bit. */ 1524167aa833SJulian Elischer if (ifp->if_flags & IFF_PROMISC) 1525167aa833SJulian Elischer MY_SETBIT(sc, MY_TCRRCR, MY_PROM); 1526167aa833SJulian Elischer else 1527167aa833SJulian Elischer MY_CLRBIT(sc, MY_TCRRCR, MY_PROM); 1528167aa833SJulian Elischer 1529167aa833SJulian Elischer /* 1530167aa833SJulian Elischer * Set capture broadcast bit to capture broadcast frames. 1531167aa833SJulian Elischer */ 1532167aa833SJulian Elischer if (ifp->if_flags & IFF_BROADCAST) 1533167aa833SJulian Elischer MY_SETBIT(sc, MY_TCRRCR, MY_AB); 1534167aa833SJulian Elischer else 1535167aa833SJulian Elischer MY_CLRBIT(sc, MY_TCRRCR, MY_AB); 1536167aa833SJulian Elischer 1537167aa833SJulian Elischer /* 1538167aa833SJulian Elischer * Program the multicast filter, if necessary. 1539167aa833SJulian Elischer */ 1540167aa833SJulian Elischer my_setmulti(sc); 1541167aa833SJulian Elischer 1542167aa833SJulian Elischer /* 1543167aa833SJulian Elischer * Load the address of the RX list. 1544167aa833SJulian Elischer */ 1545167aa833SJulian Elischer MY_CLRBIT(sc, MY_TCRRCR, MY_RE); 1546167aa833SJulian Elischer CSR_WRITE_4(sc, MY_RXLBA, vtophys(&sc->my_ldata->my_rx_list[0])); 1547167aa833SJulian Elischer 1548167aa833SJulian Elischer /* 1549167aa833SJulian Elischer * Enable interrupts. 1550167aa833SJulian Elischer */ 1551167aa833SJulian Elischer CSR_WRITE_4(sc, MY_IMR, MY_INTRS); 1552167aa833SJulian Elischer CSR_WRITE_4(sc, MY_ISR, 0xFFFFFFFF); 1553167aa833SJulian Elischer 1554167aa833SJulian Elischer /* Enable receiver and transmitter. */ 1555167aa833SJulian Elischer MY_SETBIT(sc, MY_TCRRCR, MY_RE); 1556167aa833SJulian Elischer MY_CLRBIT(sc, MY_TCRRCR, MY_TE); 1557167aa833SJulian Elischer CSR_WRITE_4(sc, MY_TXLBA, vtophys(&sc->my_ldata->my_tx_list[0])); 1558167aa833SJulian Elischer MY_SETBIT(sc, MY_TCRRCR, MY_TE); 1559167aa833SJulian Elischer 1560167aa833SJulian Elischer /* Restore state of BMCR */ 1561167aa833SJulian Elischer if (sc->my_pinfo != NULL) 1562167aa833SJulian Elischer my_phy_writereg(sc, PHY_BMCR, phy_bmcr); 156313f4c340SRobert Watson ifp->if_drv_flags |= IFF_DRV_RUNNING; 156413f4c340SRobert Watson ifp->if_drv_flags &= ~IFF_DRV_OACTIVE; 1565d4e576c4SJohn Baldwin 1566d4e576c4SJohn Baldwin callout_reset(&sc->my_watchdog, hz, my_watchdog, sc); 1567167aa833SJulian Elischer return; 1568167aa833SJulian Elischer } 1569167aa833SJulian Elischer 1570167aa833SJulian Elischer /* 1571167aa833SJulian Elischer * Set media options. 1572167aa833SJulian Elischer */ 1573167aa833SJulian Elischer 1574167aa833SJulian Elischer static int 1575167aa833SJulian Elischer my_ifmedia_upd(struct ifnet * ifp) 1576167aa833SJulian Elischer { 1577167aa833SJulian Elischer struct my_softc *sc; 1578167aa833SJulian Elischer struct ifmedia *ifm; 1579167aa833SJulian Elischer 1580167aa833SJulian Elischer sc = ifp->if_softc; 1581167aa833SJulian Elischer MY_LOCK(sc); 1582167aa833SJulian Elischer ifm = &sc->ifmedia; 1583167aa833SJulian Elischer if (IFM_TYPE(ifm->ifm_media) != IFM_ETHER) { 1584167aa833SJulian Elischer MY_UNLOCK(sc); 1585167aa833SJulian Elischer return (EINVAL); 1586167aa833SJulian Elischer } 1587167aa833SJulian Elischer if (IFM_SUBTYPE(ifm->ifm_media) == IFM_AUTO) 1588167aa833SJulian Elischer my_autoneg_mii(sc, MY_FLAG_SCHEDDELAY, 1); 1589167aa833SJulian Elischer else 1590167aa833SJulian Elischer my_setmode_mii(sc, ifm->ifm_media); 1591167aa833SJulian Elischer MY_UNLOCK(sc); 1592167aa833SJulian Elischer return (0); 1593167aa833SJulian Elischer } 1594167aa833SJulian Elischer 1595167aa833SJulian Elischer /* 1596167aa833SJulian Elischer * Report current media status. 1597167aa833SJulian Elischer */ 1598167aa833SJulian Elischer 1599167aa833SJulian Elischer static void 1600167aa833SJulian Elischer my_ifmedia_sts(struct ifnet * ifp, struct ifmediareq * ifmr) 1601167aa833SJulian Elischer { 1602167aa833SJulian Elischer struct my_softc *sc; 1603167aa833SJulian Elischer u_int16_t advert = 0, ability = 0; 1604167aa833SJulian Elischer 1605167aa833SJulian Elischer sc = ifp->if_softc; 1606167aa833SJulian Elischer MY_LOCK(sc); 1607167aa833SJulian Elischer ifmr->ifm_active = IFM_ETHER; 1608167aa833SJulian Elischer if (!(my_phy_readreg(sc, PHY_BMCR) & PHY_BMCR_AUTONEGENBL)) { 16090cde2d13SJulian Elischer #if 0 /* this version did not support 1000M, */ 16100cde2d13SJulian Elischer if (my_phy_readreg(sc, PHY_BMCR) & PHY_BMCR_1000) 16110cde2d13SJulian Elischer ifmr->ifm_active = IFM_ETHER | IFM_1000TX; 16120cde2d13SJulian Elischer #endif 1613167aa833SJulian Elischer if (my_phy_readreg(sc, PHY_BMCR) & PHY_BMCR_SPEEDSEL) 1614167aa833SJulian Elischer ifmr->ifm_active = IFM_ETHER | IFM_100_TX; 1615167aa833SJulian Elischer else 1616167aa833SJulian Elischer ifmr->ifm_active = IFM_ETHER | IFM_10_T; 1617167aa833SJulian Elischer if (my_phy_readreg(sc, PHY_BMCR) & PHY_BMCR_DUPLEX) 1618167aa833SJulian Elischer ifmr->ifm_active |= IFM_FDX; 1619167aa833SJulian Elischer else 1620167aa833SJulian Elischer ifmr->ifm_active |= IFM_HDX; 1621167aa833SJulian Elischer 1622167aa833SJulian Elischer MY_UNLOCK(sc); 1623167aa833SJulian Elischer return; 1624167aa833SJulian Elischer } 1625167aa833SJulian Elischer ability = my_phy_readreg(sc, PHY_LPAR); 1626167aa833SJulian Elischer advert = my_phy_readreg(sc, PHY_ANAR); 1627167aa833SJulian Elischer 16280cde2d13SJulian Elischer #if 0 /* this version did not support 1000M, */ 1629167aa833SJulian Elischer if (sc->my_pinfo->my_vid = MarvellPHYID0) { 1630167aa833SJulian Elischer ability2 = my_phy_readreg(sc, PHY_1000SR); 1631167aa833SJulian Elischer if (ability2 & PHY_1000SR_1000BTXFULL) { 1632167aa833SJulian Elischer advert = 0; 1633167aa833SJulian Elischer ability = 0; 1634b418ad5cSPoul-Henning Kamp ifmr->ifm_active = IFM_ETHER|IFM_1000_T|IFM_FDX; 1635167aa833SJulian Elischer } else if (ability & PHY_1000SR_1000BTXHALF) { 1636167aa833SJulian Elischer advert = 0; 1637167aa833SJulian Elischer ability = 0; 1638b418ad5cSPoul-Henning Kamp ifmr->ifm_active = IFM_ETHER|IFM_1000_T|IFM_HDX; 1639167aa833SJulian Elischer } 1640167aa833SJulian Elischer } 1641167aa833SJulian Elischer #endif 1642167aa833SJulian Elischer if (advert & PHY_ANAR_100BT4 && ability & PHY_ANAR_100BT4) 1643167aa833SJulian Elischer ifmr->ifm_active = IFM_ETHER | IFM_100_T4; 1644167aa833SJulian Elischer else if (advert & PHY_ANAR_100BTXFULL && ability & PHY_ANAR_100BTXFULL) 1645167aa833SJulian Elischer ifmr->ifm_active = IFM_ETHER | IFM_100_TX | IFM_FDX; 1646167aa833SJulian Elischer else if (advert & PHY_ANAR_100BTXHALF && ability & PHY_ANAR_100BTXHALF) 1647167aa833SJulian Elischer ifmr->ifm_active = IFM_ETHER | IFM_100_TX | IFM_HDX; 1648167aa833SJulian Elischer else if (advert & PHY_ANAR_10BTFULL && ability & PHY_ANAR_10BTFULL) 1649167aa833SJulian Elischer ifmr->ifm_active = IFM_ETHER | IFM_10_T | IFM_FDX; 1650167aa833SJulian Elischer else if (advert & PHY_ANAR_10BTHALF && ability & PHY_ANAR_10BTHALF) 1651167aa833SJulian Elischer ifmr->ifm_active = IFM_ETHER | IFM_10_T | IFM_HDX; 1652167aa833SJulian Elischer MY_UNLOCK(sc); 1653167aa833SJulian Elischer return; 1654167aa833SJulian Elischer } 1655167aa833SJulian Elischer 1656167aa833SJulian Elischer static int 1657167aa833SJulian Elischer my_ioctl(struct ifnet * ifp, u_long command, caddr_t data) 1658167aa833SJulian Elischer { 1659167aa833SJulian Elischer struct my_softc *sc = ifp->if_softc; 1660167aa833SJulian Elischer struct ifreq *ifr = (struct ifreq *) data; 1661ca5fc32dSJohn Baldwin int error; 1662167aa833SJulian Elischer 1663167aa833SJulian Elischer switch (command) { 1664167aa833SJulian Elischer case SIOCSIFFLAGS: 1665ca5fc32dSJohn Baldwin MY_LOCK(sc); 1666167aa833SJulian Elischer if (ifp->if_flags & IFF_UP) 1667ca5fc32dSJohn Baldwin my_init_locked(sc); 166813f4c340SRobert Watson else if (ifp->if_drv_flags & IFF_DRV_RUNNING) 1669167aa833SJulian Elischer my_stop(sc); 1670ca5fc32dSJohn Baldwin MY_UNLOCK(sc); 1671167aa833SJulian Elischer error = 0; 1672167aa833SJulian Elischer break; 1673167aa833SJulian Elischer case SIOCADDMULTI: 1674167aa833SJulian Elischer case SIOCDELMULTI: 1675ca5fc32dSJohn Baldwin MY_LOCK(sc); 1676167aa833SJulian Elischer my_setmulti(sc); 1677ca5fc32dSJohn Baldwin MY_UNLOCK(sc); 1678167aa833SJulian Elischer error = 0; 1679167aa833SJulian Elischer break; 1680167aa833SJulian Elischer case SIOCGIFMEDIA: 1681167aa833SJulian Elischer case SIOCSIFMEDIA: 1682167aa833SJulian Elischer error = ifmedia_ioctl(ifp, ifr, &sc->ifmedia, command); 1683167aa833SJulian Elischer break; 1684167aa833SJulian Elischer default: 1685673d9191SSam Leffler error = ether_ioctl(ifp, command, data); 1686167aa833SJulian Elischer break; 1687167aa833SJulian Elischer } 1688167aa833SJulian Elischer return (error); 1689167aa833SJulian Elischer } 1690167aa833SJulian Elischer 1691167aa833SJulian Elischer static void 1692d4e576c4SJohn Baldwin my_watchdog(void *arg) 1693167aa833SJulian Elischer { 1694167aa833SJulian Elischer struct my_softc *sc; 1695d4e576c4SJohn Baldwin struct ifnet *ifp; 1696167aa833SJulian Elischer 1697d4e576c4SJohn Baldwin sc = arg; 1698d4e576c4SJohn Baldwin MY_LOCK_ASSERT(sc); 1699d4e576c4SJohn Baldwin callout_reset(&sc->my_watchdog, hz, my_watchdog, sc); 1700d4e576c4SJohn Baldwin if (sc->my_timer == 0 || --sc->my_timer > 0) 1701167aa833SJulian Elischer return; 1702d4e576c4SJohn Baldwin 1703d4e576c4SJohn Baldwin ifp = sc->my_ifp; 1704dde47b55SGleb Smirnoff if_inc_counter(ifp, IFCOUNTER_OERRORS, 1); 170512611131SJohn Baldwin if_printf(ifp, "watchdog timeout\n"); 1706167aa833SJulian Elischer if (!(my_phy_readreg(sc, PHY_BMSR) & PHY_BMSR_LINKSTAT)) 170712611131SJohn Baldwin if_printf(ifp, "no carrier - transceiver cable problem?\n"); 1708167aa833SJulian Elischer my_stop(sc); 1709167aa833SJulian Elischer my_reset(sc); 1710ca5fc32dSJohn Baldwin my_init_locked(sc); 17119522f75aSChristian Brueffer if (!IFQ_DRV_IS_EMPTY(&ifp->if_snd)) 1712ca5fc32dSJohn Baldwin my_start_locked(ifp); 1713167aa833SJulian Elischer } 1714167aa833SJulian Elischer 1715167aa833SJulian Elischer 1716167aa833SJulian Elischer /* 1717167aa833SJulian Elischer * Stop the adapter and free any mbufs allocated to the RX and TX lists. 1718167aa833SJulian Elischer */ 1719167aa833SJulian Elischer static void 1720167aa833SJulian Elischer my_stop(struct my_softc * sc) 1721167aa833SJulian Elischer { 1722167aa833SJulian Elischer register int i; 1723167aa833SJulian Elischer struct ifnet *ifp; 1724167aa833SJulian Elischer 1725ca5fc32dSJohn Baldwin MY_LOCK_ASSERT(sc); 1726fc74a9f9SBrooks Davis ifp = sc->my_ifp; 1727d4e576c4SJohn Baldwin 1728d4e576c4SJohn Baldwin callout_stop(&sc->my_autoneg_timer); 1729d4e576c4SJohn Baldwin callout_stop(&sc->my_watchdog); 1730167aa833SJulian Elischer 1731167aa833SJulian Elischer MY_CLRBIT(sc, MY_TCRRCR, (MY_RE | MY_TE)); 1732167aa833SJulian Elischer CSR_WRITE_4(sc, MY_IMR, 0x00000000); 1733167aa833SJulian Elischer CSR_WRITE_4(sc, MY_TXLBA, 0x00000000); 1734167aa833SJulian Elischer CSR_WRITE_4(sc, MY_RXLBA, 0x00000000); 1735167aa833SJulian Elischer 1736167aa833SJulian Elischer /* 1737167aa833SJulian Elischer * Free data in the RX lists. 1738167aa833SJulian Elischer */ 1739167aa833SJulian Elischer for (i = 0; i < MY_RX_LIST_CNT; i++) { 1740167aa833SJulian Elischer if (sc->my_cdata.my_rx_chain[i].my_mbuf != NULL) { 1741167aa833SJulian Elischer m_freem(sc->my_cdata.my_rx_chain[i].my_mbuf); 1742167aa833SJulian Elischer sc->my_cdata.my_rx_chain[i].my_mbuf = NULL; 1743167aa833SJulian Elischer } 1744167aa833SJulian Elischer } 1745167aa833SJulian Elischer bzero((char *)&sc->my_ldata->my_rx_list, 1746167aa833SJulian Elischer sizeof(sc->my_ldata->my_rx_list)); 1747167aa833SJulian Elischer /* 1748167aa833SJulian Elischer * Free the TX list buffers. 1749167aa833SJulian Elischer */ 1750167aa833SJulian Elischer for (i = 0; i < MY_TX_LIST_CNT; i++) { 1751167aa833SJulian Elischer if (sc->my_cdata.my_tx_chain[i].my_mbuf != NULL) { 1752167aa833SJulian Elischer m_freem(sc->my_cdata.my_tx_chain[i].my_mbuf); 1753167aa833SJulian Elischer sc->my_cdata.my_tx_chain[i].my_mbuf = NULL; 1754167aa833SJulian Elischer } 1755167aa833SJulian Elischer } 1756167aa833SJulian Elischer bzero((char *)&sc->my_ldata->my_tx_list, 1757167aa833SJulian Elischer sizeof(sc->my_ldata->my_tx_list)); 175813f4c340SRobert Watson ifp->if_drv_flags &= ~(IFF_DRV_RUNNING | IFF_DRV_OACTIVE); 1759167aa833SJulian Elischer return; 1760167aa833SJulian Elischer } 1761167aa833SJulian Elischer 1762167aa833SJulian Elischer /* 1763167aa833SJulian Elischer * Stop all chip I/O so that the kernel's probe routines don't get confused 1764167aa833SJulian Elischer * by errant DMAs when rebooting. 1765167aa833SJulian Elischer */ 1766174ed15eSWarner Losh static int 1767167aa833SJulian Elischer my_shutdown(device_t dev) 1768167aa833SJulian Elischer { 1769167aa833SJulian Elischer struct my_softc *sc; 1770167aa833SJulian Elischer 1771167aa833SJulian Elischer sc = device_get_softc(dev); 1772ca5fc32dSJohn Baldwin MY_LOCK(sc); 1773167aa833SJulian Elischer my_stop(sc); 1774ca5fc32dSJohn Baldwin MY_UNLOCK(sc); 1775174ed15eSWarner Losh return 0; 1776167aa833SJulian Elischer } 1777