if_my.c revision 207554
1119418Sobrien/*- 2119418Sobrien * Written by: yen_cw@myson.com.tw 393746Sjulian * Copyright (c) 2002 Myson Technology Inc. 493746Sjulian * All rights reserved. 593746Sjulian * 693746Sjulian * Redistribution and use in source and binary forms, with or without 793746Sjulian * modification, are permitted provided that the following conditions 893746Sjulian * are met: 993746Sjulian * 1. Redistributions of source code must retain the above copyright 1093746Sjulian * notice, this list of conditions, and the following disclaimer, 1193746Sjulian * without modification, immediately at the beginning of the file. 1293746Sjulian * 2. The name of the author may not be used to endorse or promote products 1393746Sjulian * derived from this software without specific prior written permission. 1493746Sjulian * 1593746Sjulian * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND 1693746Sjulian * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 1793746Sjulian * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 1893746Sjulian * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE FOR 1993746Sjulian * ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 2093746Sjulian * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 2193746Sjulian * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 2293746Sjulian * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 2393746Sjulian * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 2493746Sjulian * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 2593746Sjulian * SUCH DAMAGE. 2693746Sjulian * 27119418Sobrien * Myson fast ethernet PCI NIC driver, available at: http://www.myson.com.tw/ 2893746Sjulian */ 29113038Sobrien 30113038Sobrien#include <sys/cdefs.h> 31113038Sobrien__FBSDID("$FreeBSD: head/sys/dev/my/if_my.c 207554 2010-05-03 07:32:50Z sobomax $"); 32113038Sobrien 3393746Sjulian#include <sys/param.h> 3493746Sjulian#include <sys/systm.h> 3593746Sjulian#include <sys/sockio.h> 3693746Sjulian#include <sys/mbuf.h> 3793746Sjulian#include <sys/malloc.h> 3893746Sjulian#include <sys/kernel.h> 3993746Sjulian#include <sys/socket.h> 4093746Sjulian#include <sys/queue.h> 4193746Sjulian#include <sys/types.h> 4293746Sjulian#include <sys/bus.h> 4393746Sjulian#include <sys/module.h> 4495807Sjulian#include <sys/lock.h> 4595807Sjulian#include <sys/mutex.h> 4693746Sjulian 4793746Sjulian#define NBPFILTER 1 4893746Sjulian 4993746Sjulian#include <net/if.h> 5093746Sjulian#include <net/if_arp.h> 5193746Sjulian#include <net/ethernet.h> 5293746Sjulian#include <net/if_media.h> 53147256Sbrooks#include <net/if_types.h> 5493746Sjulian#include <net/if_dl.h> 5593746Sjulian#include <net/bpf.h> 5693746Sjulian 5793746Sjulian#include <vm/vm.h> /* for vtophys */ 5893746Sjulian#include <vm/pmap.h> /* for vtophys */ 5993746Sjulian#include <machine/bus.h> 6093746Sjulian#include <machine/resource.h> 6193746Sjulian#include <sys/bus.h> 6293746Sjulian#include <sys/rman.h> 6393746Sjulian 64119285Simp#include <dev/pci/pcireg.h> 65119285Simp#include <dev/pci/pcivar.h> 6693746Sjulian 6793746Sjulian/* 6893746Sjulian * #define MY_USEIOSPACE 6993746Sjulian */ 7093746Sjulian 7193746Sjulianstatic int MY_USEIOSPACE = 1; 7293746Sjulian 73153084Sru#ifdef MY_USEIOSPACE 7494904Sjulian#define MY_RES SYS_RES_IOPORT 7594904Sjulian#define MY_RID MY_PCI_LOIO 7693746Sjulian#else 7794904Sjulian#define MY_RES SYS_RES_MEMORY 7894904Sjulian#define MY_RID MY_PCI_LOMEM 7993746Sjulian#endif 8093746Sjulian 8193746Sjulian 8293746Sjulian#include <dev/my/if_myreg.h> 8393746Sjulian 8493746Sjulian#ifndef lint 8593746Sjulianstatic const char rcsid[] = 86119285Simp"$Id: if_my.c,v 1.16 2003/04/15 06:37:25 mdodd Exp $"; 8793746Sjulian#endif 8893746Sjulian 8993746Sjulian/* 9093746Sjulian * Various supported device vendors/types and their names. 9193746Sjulian */ 9293746Sjulianstruct my_type *my_info_tmp; 9393746Sjulianstatic struct my_type my_devs[] = { 9493746Sjulian {MYSONVENDORID, MTD800ID, "Myson MTD80X Based Fast Ethernet Card"}, 9593746Sjulian {MYSONVENDORID, MTD803ID, "Myson MTD80X Based Fast Ethernet Card"}, 9693746Sjulian {MYSONVENDORID, MTD891ID, "Myson MTD89X Based Giga Ethernet Card"}, 9793746Sjulian {0, 0, NULL} 9893746Sjulian}; 9993746Sjulian 10093746Sjulian/* 10193746Sjulian * Various supported PHY vendors/types and their names. Note that this driver 10293746Sjulian * will work with pretty much any MII-compliant PHY, so failure to positively 10393746Sjulian * identify the chip is not a fatal error. 10493746Sjulian */ 10593746Sjulianstatic struct my_type my_phys[] = { 10693746Sjulian {MysonPHYID0, MysonPHYID0, "<MYSON MTD981>"}, 10793746Sjulian {SeeqPHYID0, SeeqPHYID0, "<SEEQ 80225>"}, 10893746Sjulian {AhdocPHYID0, AhdocPHYID0, "<AHDOC 101>"}, 10993746Sjulian {MarvellPHYID0, MarvellPHYID0, "<MARVELL 88E1000>"}, 11093746Sjulian {LevelOnePHYID0, LevelOnePHYID0, "<LevelOne LXT1000>"}, 11193746Sjulian {0, 0, "<MII-compliant physical interface>"} 11293746Sjulian}; 11393746Sjulian 11493746Sjulianstatic int my_probe(device_t); 11593746Sjulianstatic int my_attach(device_t); 11693746Sjulianstatic int my_detach(device_t); 11793746Sjulianstatic int my_newbuf(struct my_softc *, struct my_chain_onefrag *); 11893746Sjulianstatic int my_encap(struct my_softc *, struct my_chain *, struct mbuf *); 11993746Sjulianstatic void my_rxeof(struct my_softc *); 12093746Sjulianstatic void my_txeof(struct my_softc *); 12193746Sjulianstatic void my_txeoc(struct my_softc *); 12293746Sjulianstatic void my_intr(void *); 12393746Sjulianstatic void my_start(struct ifnet *); 124149151Sjhbstatic void my_start_locked(struct ifnet *); 12593746Sjulianstatic int my_ioctl(struct ifnet *, u_long, caddr_t); 12693746Sjulianstatic void my_init(void *); 127149151Sjhbstatic void my_init_locked(struct my_softc *); 12893746Sjulianstatic void my_stop(struct my_softc *); 129199540Sjhbstatic void my_autoneg_timeout(void *); 130199540Sjhbstatic void my_watchdog(void *); 131188172Simpstatic int my_shutdown(device_t); 13293746Sjulianstatic int my_ifmedia_upd(struct ifnet *); 13393746Sjulianstatic void my_ifmedia_sts(struct ifnet *, struct ifmediareq *); 13493746Sjulianstatic u_int16_t my_phy_readreg(struct my_softc *, int); 13593746Sjulianstatic void my_phy_writereg(struct my_softc *, int, int); 13693746Sjulianstatic void my_autoneg_xmit(struct my_softc *); 13793746Sjulianstatic void my_autoneg_mii(struct my_softc *, int, int); 13893746Sjulianstatic void my_setmode_mii(struct my_softc *, int); 13993746Sjulianstatic void my_getmode_mii(struct my_softc *); 14093746Sjulianstatic void my_setcfg(struct my_softc *, int); 14193746Sjulianstatic void my_setmulti(struct my_softc *); 14293746Sjulianstatic void my_reset(struct my_softc *); 14393746Sjulianstatic int my_list_rx_init(struct my_softc *); 14493746Sjulianstatic int my_list_tx_init(struct my_softc *); 14593746Sjulianstatic long my_send_cmd_to_phy(struct my_softc *, int, int); 14693746Sjulian 147106696Salfred#define MY_SETBIT(sc, reg, x) CSR_WRITE_4(sc, reg, CSR_READ_4(sc, reg) | (x)) 148106696Salfred#define MY_CLRBIT(sc, reg, x) CSR_WRITE_4(sc, reg, CSR_READ_4(sc, reg) & ~(x)) 14993746Sjulian 15093746Sjulianstatic device_method_t my_methods[] = { 15193746Sjulian /* Device interface */ 15293746Sjulian DEVMETHOD(device_probe, my_probe), 15393746Sjulian DEVMETHOD(device_attach, my_attach), 15493746Sjulian DEVMETHOD(device_detach, my_detach), 15593746Sjulian DEVMETHOD(device_shutdown, my_shutdown), 15693746Sjulian 15793746Sjulian {0, 0} 15893746Sjulian}; 15993746Sjulian 16093746Sjulianstatic driver_t my_driver = { 16193746Sjulian "my", 16293746Sjulian my_methods, 16393746Sjulian sizeof(struct my_softc) 16493746Sjulian}; 16593746Sjulian 16693746Sjulianstatic devclass_t my_devclass; 16793746Sjulian 168113506SmdoddDRIVER_MODULE(my, pci, my_driver, my_devclass, 0, 0); 169113506SmdoddMODULE_DEPEND(my, pci, 1, 1, 1); 170113506SmdoddMODULE_DEPEND(my, ether, 1, 1, 1); 17193746Sjulian 17293746Sjulianstatic long 17393746Sjulianmy_send_cmd_to_phy(struct my_softc * sc, int opcode, int regad) 17493746Sjulian{ 17593746Sjulian long miir; 17693746Sjulian int i; 17793746Sjulian int mask, data; 17893746Sjulian 179149151Sjhb MY_LOCK_ASSERT(sc); 18093746Sjulian 18193746Sjulian /* enable MII output */ 18293746Sjulian miir = CSR_READ_4(sc, MY_MANAGEMENT); 18393746Sjulian miir &= 0xfffffff0; 18493746Sjulian 18593746Sjulian miir |= MY_MASK_MIIR_MII_WRITE + MY_MASK_MIIR_MII_MDO; 18693746Sjulian 18793746Sjulian /* send 32 1's preamble */ 18893746Sjulian for (i = 0; i < 32; i++) { 18993746Sjulian /* low MDC; MDO is already high (miir) */ 19093746Sjulian miir &= ~MY_MASK_MIIR_MII_MDC; 19193746Sjulian CSR_WRITE_4(sc, MY_MANAGEMENT, miir); 19293746Sjulian 19393746Sjulian /* high MDC */ 19493746Sjulian miir |= MY_MASK_MIIR_MII_MDC; 19593746Sjulian CSR_WRITE_4(sc, MY_MANAGEMENT, miir); 19693746Sjulian } 19793746Sjulian 19893746Sjulian /* calculate ST+OP+PHYAD+REGAD+TA */ 19993746Sjulian data = opcode | (sc->my_phy_addr << 7) | (regad << 2); 20093746Sjulian 20193746Sjulian /* sent out */ 20293746Sjulian mask = 0x8000; 20393746Sjulian while (mask) { 20493746Sjulian /* low MDC, prepare MDO */ 20593746Sjulian miir &= ~(MY_MASK_MIIR_MII_MDC + MY_MASK_MIIR_MII_MDO); 20693746Sjulian if (mask & data) 20793746Sjulian miir |= MY_MASK_MIIR_MII_MDO; 20893746Sjulian 20993746Sjulian CSR_WRITE_4(sc, MY_MANAGEMENT, miir); 21093746Sjulian /* high MDC */ 21193746Sjulian miir |= MY_MASK_MIIR_MII_MDC; 21293746Sjulian CSR_WRITE_4(sc, MY_MANAGEMENT, miir); 21393746Sjulian DELAY(30); 21493746Sjulian 21593746Sjulian /* next */ 21693746Sjulian mask >>= 1; 21793746Sjulian if (mask == 0x2 && opcode == MY_OP_READ) 21893746Sjulian miir &= ~MY_MASK_MIIR_MII_WRITE; 21993746Sjulian } 22093746Sjulian 22193746Sjulian return miir; 22293746Sjulian} 22393746Sjulian 22493746Sjulian 225148945Sjhbstatic u_int16_t 22693746Sjulianmy_phy_readreg(struct my_softc * sc, int reg) 22793746Sjulian{ 22893746Sjulian long miir; 22993746Sjulian int mask, data; 23093746Sjulian 231149151Sjhb MY_LOCK_ASSERT(sc); 23293746Sjulian 23393746Sjulian if (sc->my_info->my_did == MTD803ID) 23493746Sjulian data = CSR_READ_2(sc, MY_PHYBASE + reg * 2); 23593746Sjulian else { 23693746Sjulian miir = my_send_cmd_to_phy(sc, MY_OP_READ, reg); 23793746Sjulian 23893746Sjulian /* read data */ 23993746Sjulian mask = 0x8000; 24093746Sjulian data = 0; 24193746Sjulian while (mask) { 24293746Sjulian /* low MDC */ 24393746Sjulian miir &= ~MY_MASK_MIIR_MII_MDC; 24493746Sjulian CSR_WRITE_4(sc, MY_MANAGEMENT, miir); 24593746Sjulian 24693746Sjulian /* read MDI */ 24793746Sjulian miir = CSR_READ_4(sc, MY_MANAGEMENT); 24893746Sjulian if (miir & MY_MASK_MIIR_MII_MDI) 24993746Sjulian data |= mask; 25093746Sjulian 25193746Sjulian /* high MDC, and wait */ 25293746Sjulian miir |= MY_MASK_MIIR_MII_MDC; 25393746Sjulian CSR_WRITE_4(sc, MY_MANAGEMENT, miir); 25493746Sjulian DELAY(30); 25593746Sjulian 25693746Sjulian /* next */ 25793746Sjulian mask >>= 1; 25893746Sjulian } 25993746Sjulian 26093746Sjulian /* low MDC */ 26193746Sjulian miir &= ~MY_MASK_MIIR_MII_MDC; 26293746Sjulian CSR_WRITE_4(sc, MY_MANAGEMENT, miir); 26393746Sjulian } 26493746Sjulian 26593746Sjulian return (u_int16_t) data; 26693746Sjulian} 26793746Sjulian 26893746Sjulian 26993746Sjulianstatic void 27093746Sjulianmy_phy_writereg(struct my_softc * sc, int reg, int data) 27193746Sjulian{ 27293746Sjulian long miir; 27393746Sjulian int mask; 27493746Sjulian 275149151Sjhb MY_LOCK_ASSERT(sc); 27693746Sjulian 27793746Sjulian if (sc->my_info->my_did == MTD803ID) 27893746Sjulian CSR_WRITE_2(sc, MY_PHYBASE + reg * 2, data); 27993746Sjulian else { 28093746Sjulian miir = my_send_cmd_to_phy(sc, MY_OP_WRITE, reg); 28193746Sjulian 28293746Sjulian /* write data */ 28393746Sjulian mask = 0x8000; 28493746Sjulian while (mask) { 28593746Sjulian /* low MDC, prepare MDO */ 28693746Sjulian miir &= ~(MY_MASK_MIIR_MII_MDC + MY_MASK_MIIR_MII_MDO); 28793746Sjulian if (mask & data) 28893746Sjulian miir |= MY_MASK_MIIR_MII_MDO; 28993746Sjulian CSR_WRITE_4(sc, MY_MANAGEMENT, miir); 29093746Sjulian DELAY(1); 29193746Sjulian 29293746Sjulian /* high MDC */ 29393746Sjulian miir |= MY_MASK_MIIR_MII_MDC; 29493746Sjulian CSR_WRITE_4(sc, MY_MANAGEMENT, miir); 29593746Sjulian DELAY(1); 29693746Sjulian 29793746Sjulian /* next */ 29893746Sjulian mask >>= 1; 29993746Sjulian } 30093746Sjulian 30193746Sjulian /* low MDC */ 30293746Sjulian miir &= ~MY_MASK_MIIR_MII_MDC; 30393746Sjulian CSR_WRITE_4(sc, MY_MANAGEMENT, miir); 30493746Sjulian } 30593746Sjulian return; 30693746Sjulian} 30793746Sjulian 30893746Sjulian 30993746Sjulian/* 31093746Sjulian * Program the 64-bit multicast hash filter. 31193746Sjulian */ 31293746Sjulianstatic void 31393746Sjulianmy_setmulti(struct my_softc * sc) 31493746Sjulian{ 31593746Sjulian struct ifnet *ifp; 31693746Sjulian int h = 0; 31793746Sjulian u_int32_t hashes[2] = {0, 0}; 31893746Sjulian struct ifmultiaddr *ifma; 31993746Sjulian u_int32_t rxfilt; 32093746Sjulian int mcnt = 0; 32193746Sjulian 322149151Sjhb MY_LOCK_ASSERT(sc); 32393746Sjulian 324147256Sbrooks ifp = sc->my_ifp; 32593746Sjulian 32693746Sjulian rxfilt = CSR_READ_4(sc, MY_TCRRCR); 32793746Sjulian 32893746Sjulian if (ifp->if_flags & IFF_ALLMULTI || ifp->if_flags & IFF_PROMISC) { 32993746Sjulian rxfilt |= MY_AM; 33093746Sjulian CSR_WRITE_4(sc, MY_TCRRCR, rxfilt); 33193746Sjulian CSR_WRITE_4(sc, MY_MAR0, 0xFFFFFFFF); 33293746Sjulian CSR_WRITE_4(sc, MY_MAR1, 0xFFFFFFFF); 33393746Sjulian 33493746Sjulian return; 33593746Sjulian } 33693746Sjulian /* first, zot all the existing hash bits */ 33793746Sjulian CSR_WRITE_4(sc, MY_MAR0, 0); 33893746Sjulian CSR_WRITE_4(sc, MY_MAR1, 0); 33993746Sjulian 34093746Sjulian /* now program new ones */ 341195049Srwatson if_maddr_rlock(ifp); 34293746Sjulian TAILQ_FOREACH(ifma, &ifp->if_multiaddrs, ifma_link) { 34393746Sjulian if (ifma->ifma_addr->sa_family != AF_LINK) 34493746Sjulian continue; 345130270Snaddy h = ~ether_crc32_be(LLADDR((struct sockaddr_dl *) 346130270Snaddy ifma->ifma_addr), ETHER_ADDR_LEN) >> 26; 34793746Sjulian if (h < 32) 34893746Sjulian hashes[0] |= (1 << h); 34993746Sjulian else 35093746Sjulian hashes[1] |= (1 << (h - 32)); 35193746Sjulian mcnt++; 35293746Sjulian } 353195049Srwatson if_maddr_runlock(ifp); 35493746Sjulian 35593746Sjulian if (mcnt) 35693746Sjulian rxfilt |= MY_AM; 35793746Sjulian else 35893746Sjulian rxfilt &= ~MY_AM; 35993746Sjulian CSR_WRITE_4(sc, MY_MAR0, hashes[0]); 36093746Sjulian CSR_WRITE_4(sc, MY_MAR1, hashes[1]); 36193746Sjulian CSR_WRITE_4(sc, MY_TCRRCR, rxfilt); 36293746Sjulian return; 36393746Sjulian} 36493746Sjulian 36593746Sjulian/* 36693746Sjulian * Initiate an autonegotiation session. 36793746Sjulian */ 36893746Sjulianstatic void 36993746Sjulianmy_autoneg_xmit(struct my_softc * sc) 37093746Sjulian{ 37193746Sjulian u_int16_t phy_sts = 0; 37293746Sjulian 373149151Sjhb MY_LOCK_ASSERT(sc); 37493746Sjulian 37593746Sjulian my_phy_writereg(sc, PHY_BMCR, PHY_BMCR_RESET); 37693746Sjulian DELAY(500); 37793746Sjulian while (my_phy_readreg(sc, PHY_BMCR) & PHY_BMCR_RESET); 37893746Sjulian 37993746Sjulian phy_sts = my_phy_readreg(sc, PHY_BMCR); 38093746Sjulian phy_sts |= PHY_BMCR_AUTONEGENBL | PHY_BMCR_AUTONEGRSTR; 38193746Sjulian my_phy_writereg(sc, PHY_BMCR, phy_sts); 38293746Sjulian 38393746Sjulian return; 38493746Sjulian} 38593746Sjulian 386199540Sjhbstatic void 387199540Sjhbmy_autoneg_timeout(void *arg) 388199540Sjhb{ 389199540Sjhb struct my_softc *sc; 39093746Sjulian 391199540Sjhb sc = arg; 392199540Sjhb MY_LOCK_ASSERT(sc); 393199540Sjhb my_autoneg_mii(sc, MY_FLAG_DELAYTIMEO, 1); 394199540Sjhb} 395199540Sjhb 39693746Sjulian/* 39793746Sjulian * Invoke autonegotiation on a PHY. 39893746Sjulian */ 39993746Sjulianstatic void 40093746Sjulianmy_autoneg_mii(struct my_softc * sc, int flag, int verbose) 40193746Sjulian{ 40293746Sjulian u_int16_t phy_sts = 0, media, advert, ability; 40393746Sjulian u_int16_t ability2 = 0; 40493746Sjulian struct ifnet *ifp; 40593746Sjulian struct ifmedia *ifm; 40693746Sjulian 407149151Sjhb MY_LOCK_ASSERT(sc); 40893746Sjulian 40993746Sjulian ifm = &sc->ifmedia; 410147256Sbrooks ifp = sc->my_ifp; 41193746Sjulian 41293746Sjulian ifm->ifm_media = IFM_ETHER | IFM_AUTO; 41393746Sjulian 41493746Sjulian#ifndef FORCE_AUTONEG_TFOUR 41593746Sjulian /* 41693746Sjulian * First, see if autoneg is supported. If not, there's no point in 41793746Sjulian * continuing. 41893746Sjulian */ 41993746Sjulian phy_sts = my_phy_readreg(sc, PHY_BMSR); 42093746Sjulian if (!(phy_sts & PHY_BMSR_CANAUTONEG)) { 42193746Sjulian if (verbose) 422162321Sglebius device_printf(sc->my_dev, 423162321Sglebius "autonegotiation not supported\n"); 42493746Sjulian ifm->ifm_media = IFM_ETHER | IFM_10_T | IFM_HDX; 42593746Sjulian return; 42693746Sjulian } 42793746Sjulian#endif 42893746Sjulian switch (flag) { 42993746Sjulian case MY_FLAG_FORCEDELAY: 43093746Sjulian /* 43193746Sjulian * XXX Never use this option anywhere but in the probe 43293746Sjulian * routine: making the kernel stop dead in its tracks for 43393746Sjulian * three whole seconds after we've gone multi-user is really 43493746Sjulian * bad manners. 43593746Sjulian */ 43693746Sjulian my_autoneg_xmit(sc); 43793746Sjulian DELAY(5000000); 43893746Sjulian break; 43993746Sjulian case MY_FLAG_SCHEDDELAY: 44093746Sjulian /* 44193746Sjulian * Wait for the transmitter to go idle before starting an 44293746Sjulian * autoneg session, otherwise my_start() may clobber our 44393746Sjulian * timeout, and we don't want to allow transmission during an 44493746Sjulian * autoneg session since that can screw it up. 44593746Sjulian */ 44693746Sjulian if (sc->my_cdata.my_tx_head != NULL) { 44793746Sjulian sc->my_want_auto = 1; 44893746Sjulian MY_UNLOCK(sc); 44993746Sjulian return; 45093746Sjulian } 45193746Sjulian my_autoneg_xmit(sc); 452199540Sjhb callout_reset(&sc->my_autoneg_timer, hz * 5, my_autoneg_timeout, 453199540Sjhb sc); 45493746Sjulian sc->my_autoneg = 1; 45593746Sjulian sc->my_want_auto = 0; 45693746Sjulian return; 45793746Sjulian case MY_FLAG_DELAYTIMEO: 458199540Sjhb callout_stop(&sc->my_autoneg_timer); 45993746Sjulian sc->my_autoneg = 0; 46093746Sjulian break; 46193746Sjulian default: 462162321Sglebius device_printf(sc->my_dev, "invalid autoneg flag: %d\n", flag); 46393746Sjulian return; 46493746Sjulian } 46593746Sjulian 46693746Sjulian if (my_phy_readreg(sc, PHY_BMSR) & PHY_BMSR_AUTONEGCOMP) { 46793746Sjulian if (verbose) 468162321Sglebius device_printf(sc->my_dev, "autoneg complete, "); 46993746Sjulian phy_sts = my_phy_readreg(sc, PHY_BMSR); 47093746Sjulian } else { 47193746Sjulian if (verbose) 472162321Sglebius device_printf(sc->my_dev, "autoneg not complete, "); 47393746Sjulian } 47493746Sjulian 47593746Sjulian media = my_phy_readreg(sc, PHY_BMCR); 47693746Sjulian 47793746Sjulian /* Link is good. Report modes and set duplex mode. */ 47893746Sjulian if (my_phy_readreg(sc, PHY_BMSR) & PHY_BMSR_LINKSTAT) { 47993746Sjulian if (verbose) 480162321Sglebius device_printf(sc->my_dev, "link status good. "); 48193746Sjulian advert = my_phy_readreg(sc, PHY_ANAR); 48293746Sjulian ability = my_phy_readreg(sc, PHY_LPAR); 48393746Sjulian if ((sc->my_pinfo->my_vid == MarvellPHYID0) || 48493746Sjulian (sc->my_pinfo->my_vid == LevelOnePHYID0)) { 48593746Sjulian ability2 = my_phy_readreg(sc, PHY_1000SR); 48693746Sjulian if (ability2 & PHY_1000SR_1000BTXFULL) { 48793746Sjulian advert = 0; 48893746Sjulian ability = 0; 48993746Sjulian /* 49093746Sjulian * this version did not support 1000M, 49193746Sjulian * ifm->ifm_media = 49295673Sphk * IFM_ETHER|IFM_1000_T|IFM_FDX; 49393746Sjulian */ 49493746Sjulian ifm->ifm_media = 49593746Sjulian IFM_ETHER | IFM_100_TX | IFM_FDX; 49693746Sjulian media &= ~PHY_BMCR_SPEEDSEL; 49793746Sjulian media |= PHY_BMCR_1000; 49893746Sjulian media |= PHY_BMCR_DUPLEX; 49993746Sjulian printf("(full-duplex, 1000Mbps)\n"); 50093746Sjulian } else if (ability2 & PHY_1000SR_1000BTXHALF) { 50193746Sjulian advert = 0; 50293746Sjulian ability = 0; 50393746Sjulian /* 50493746Sjulian * this version did not support 1000M, 50595673Sphk * ifm->ifm_media = IFM_ETHER|IFM_1000_T; 50693746Sjulian */ 50793746Sjulian ifm->ifm_media = IFM_ETHER | IFM_100_TX; 50893746Sjulian media &= ~PHY_BMCR_SPEEDSEL; 50993746Sjulian media &= ~PHY_BMCR_DUPLEX; 51093746Sjulian media |= PHY_BMCR_1000; 51193746Sjulian printf("(half-duplex, 1000Mbps)\n"); 51293746Sjulian } 51393746Sjulian } 51493746Sjulian if (advert & PHY_ANAR_100BT4 && ability & PHY_ANAR_100BT4) { 51593746Sjulian ifm->ifm_media = IFM_ETHER | IFM_100_T4; 51693746Sjulian media |= PHY_BMCR_SPEEDSEL; 51793746Sjulian media &= ~PHY_BMCR_DUPLEX; 51893746Sjulian printf("(100baseT4)\n"); 51993746Sjulian } else if (advert & PHY_ANAR_100BTXFULL && 52093746Sjulian ability & PHY_ANAR_100BTXFULL) { 52193746Sjulian ifm->ifm_media = IFM_ETHER | IFM_100_TX | IFM_FDX; 52293746Sjulian media |= PHY_BMCR_SPEEDSEL; 52393746Sjulian media |= PHY_BMCR_DUPLEX; 52493746Sjulian printf("(full-duplex, 100Mbps)\n"); 52593746Sjulian } else if (advert & PHY_ANAR_100BTXHALF && 52693746Sjulian ability & PHY_ANAR_100BTXHALF) { 52793746Sjulian ifm->ifm_media = IFM_ETHER | IFM_100_TX | IFM_HDX; 52893746Sjulian media |= PHY_BMCR_SPEEDSEL; 52993746Sjulian media &= ~PHY_BMCR_DUPLEX; 53093746Sjulian printf("(half-duplex, 100Mbps)\n"); 53193746Sjulian } else if (advert & PHY_ANAR_10BTFULL && 53293746Sjulian ability & PHY_ANAR_10BTFULL) { 53393746Sjulian ifm->ifm_media = IFM_ETHER | IFM_10_T | IFM_FDX; 53493746Sjulian media &= ~PHY_BMCR_SPEEDSEL; 53593746Sjulian media |= PHY_BMCR_DUPLEX; 53693746Sjulian printf("(full-duplex, 10Mbps)\n"); 53793746Sjulian } else if (advert) { 53893746Sjulian ifm->ifm_media = IFM_ETHER | IFM_10_T | IFM_HDX; 53993746Sjulian media &= ~PHY_BMCR_SPEEDSEL; 54093746Sjulian media &= ~PHY_BMCR_DUPLEX; 54193746Sjulian printf("(half-duplex, 10Mbps)\n"); 54293746Sjulian } 54393746Sjulian media &= ~PHY_BMCR_AUTONEGENBL; 54493746Sjulian 54593746Sjulian /* Set ASIC's duplex mode to match the PHY. */ 54693746Sjulian my_phy_writereg(sc, PHY_BMCR, media); 54793746Sjulian my_setcfg(sc, media); 54893746Sjulian } else { 54993746Sjulian if (verbose) 550162321Sglebius device_printf(sc->my_dev, "no carrier\n"); 55193746Sjulian } 55293746Sjulian 553149151Sjhb my_init_locked(sc); 55493746Sjulian if (sc->my_tx_pend) { 55593746Sjulian sc->my_autoneg = 0; 55693746Sjulian sc->my_tx_pend = 0; 557149151Sjhb my_start_locked(ifp); 55893746Sjulian } 55993746Sjulian return; 56093746Sjulian} 56193746Sjulian 56293746Sjulian/* 56393746Sjulian * To get PHY ability. 56493746Sjulian */ 56593746Sjulianstatic void 56693746Sjulianmy_getmode_mii(struct my_softc * sc) 56793746Sjulian{ 56893746Sjulian u_int16_t bmsr; 56993746Sjulian struct ifnet *ifp; 57093746Sjulian 571149151Sjhb MY_LOCK_ASSERT(sc); 572147256Sbrooks ifp = sc->my_ifp; 57393746Sjulian bmsr = my_phy_readreg(sc, PHY_BMSR); 57493746Sjulian if (bootverbose) 575162321Sglebius device_printf(sc->my_dev, "PHY status word: %x\n", bmsr); 57693746Sjulian 57793746Sjulian /* fallback */ 57893746Sjulian sc->ifmedia.ifm_media = IFM_ETHER | IFM_10_T | IFM_HDX; 57993746Sjulian 58093746Sjulian if (bmsr & PHY_BMSR_10BTHALF) { 58193746Sjulian if (bootverbose) 582162321Sglebius device_printf(sc->my_dev, 583162321Sglebius "10Mbps half-duplex mode supported\n"); 58493746Sjulian ifmedia_add(&sc->ifmedia, IFM_ETHER | IFM_10_T | IFM_HDX, 58593746Sjulian 0, NULL); 58693746Sjulian ifmedia_add(&sc->ifmedia, IFM_ETHER | IFM_10_T, 0, NULL); 58793746Sjulian } 58893746Sjulian if (bmsr & PHY_BMSR_10BTFULL) { 58993746Sjulian if (bootverbose) 590162321Sglebius device_printf(sc->my_dev, 591162321Sglebius "10Mbps full-duplex mode supported\n"); 59293746Sjulian 59393746Sjulian ifmedia_add(&sc->ifmedia, IFM_ETHER | IFM_10_T | IFM_FDX, 59493746Sjulian 0, NULL); 59593746Sjulian sc->ifmedia.ifm_media = IFM_ETHER | IFM_10_T | IFM_FDX; 59693746Sjulian } 59793746Sjulian if (bmsr & PHY_BMSR_100BTXHALF) { 59893746Sjulian if (bootverbose) 599162321Sglebius device_printf(sc->my_dev, 600162321Sglebius "100Mbps half-duplex mode supported\n"); 60193746Sjulian ifp->if_baudrate = 100000000; 60293746Sjulian ifmedia_add(&sc->ifmedia, IFM_ETHER | IFM_100_TX, 0, NULL); 60393746Sjulian ifmedia_add(&sc->ifmedia, IFM_ETHER | IFM_100_TX | IFM_HDX, 60493746Sjulian 0, NULL); 60593746Sjulian sc->ifmedia.ifm_media = IFM_ETHER | IFM_100_TX | IFM_HDX; 60693746Sjulian } 60793746Sjulian if (bmsr & PHY_BMSR_100BTXFULL) { 60893746Sjulian if (bootverbose) 609162321Sglebius device_printf(sc->my_dev, 610162321Sglebius "100Mbps full-duplex mode supported\n"); 61193746Sjulian ifp->if_baudrate = 100000000; 61293746Sjulian ifmedia_add(&sc->ifmedia, IFM_ETHER | IFM_100_TX | IFM_FDX, 61393746Sjulian 0, NULL); 61493746Sjulian sc->ifmedia.ifm_media = IFM_ETHER | IFM_100_TX | IFM_FDX; 61593746Sjulian } 61693746Sjulian /* Some also support 100BaseT4. */ 61793746Sjulian if (bmsr & PHY_BMSR_100BT4) { 61893746Sjulian if (bootverbose) 619162321Sglebius device_printf(sc->my_dev, "100baseT4 mode supported\n"); 62093746Sjulian ifp->if_baudrate = 100000000; 62193746Sjulian ifmedia_add(&sc->ifmedia, IFM_ETHER | IFM_100_T4, 0, NULL); 62293746Sjulian sc->ifmedia.ifm_media = IFM_ETHER | IFM_100_T4; 62393746Sjulian#ifdef FORCE_AUTONEG_TFOUR 62493746Sjulian if (bootverbose) 625162321Sglebius device_printf(sc->my_dev, 626162321Sglebius "forcing on autoneg support for BT4\n"); 62793746Sjulian ifmedia_add(&sc->ifmedia, IFM_ETHER | IFM_AUTO, 0 NULL): 62893746Sjulian sc->ifmedia.ifm_media = IFM_ETHER | IFM_AUTO; 62993746Sjulian#endif 63093746Sjulian } 63194863Sjulian#if 0 /* this version did not support 1000M, */ 63293746Sjulian if (sc->my_pinfo->my_vid == MarvellPHYID0) { 63393746Sjulian if (bootverbose) 634162321Sglebius device_printf(sc->my_dev, 635162321Sglebius "1000Mbps half-duplex mode supported\n"); 63693746Sjulian 63793746Sjulian ifp->if_baudrate = 1000000000; 63895673Sphk ifmedia_add(&sc->ifmedia, IFM_ETHER | IFM_1000_T, 0, NULL); 63995673Sphk ifmedia_add(&sc->ifmedia, IFM_ETHER | IFM_1000_T | IFM_HDX, 64093746Sjulian 0, NULL); 64193746Sjulian if (bootverbose) 642162321Sglebius device_printf(sc->my_dev, 643162321Sglebius "1000Mbps full-duplex mode supported\n"); 64493746Sjulian ifp->if_baudrate = 1000000000; 64595673Sphk ifmedia_add(&sc->ifmedia, IFM_ETHER | IFM_1000_T | IFM_FDX, 64693746Sjulian 0, NULL); 64795673Sphk sc->ifmedia.ifm_media = IFM_ETHER | IFM_1000_T | IFM_FDX; 64893746Sjulian } 64993746Sjulian#endif 65093746Sjulian if (bmsr & PHY_BMSR_CANAUTONEG) { 65193746Sjulian if (bootverbose) 652162321Sglebius device_printf(sc->my_dev, "autoneg supported\n"); 65393746Sjulian ifmedia_add(&sc->ifmedia, IFM_ETHER | IFM_AUTO, 0, NULL); 65493746Sjulian sc->ifmedia.ifm_media = IFM_ETHER | IFM_AUTO; 65593746Sjulian } 65693746Sjulian return; 65793746Sjulian} 65893746Sjulian 65993746Sjulian/* 66093746Sjulian * Set speed and duplex mode. 66193746Sjulian */ 66293746Sjulianstatic void 66393746Sjulianmy_setmode_mii(struct my_softc * sc, int media) 66493746Sjulian{ 66593746Sjulian u_int16_t bmcr; 66693746Sjulian struct ifnet *ifp; 66793746Sjulian 668149151Sjhb MY_LOCK_ASSERT(sc); 669147256Sbrooks ifp = sc->my_ifp; 67093746Sjulian /* 67193746Sjulian * If an autoneg session is in progress, stop it. 67293746Sjulian */ 67393746Sjulian if (sc->my_autoneg) { 674162321Sglebius device_printf(sc->my_dev, "canceling autoneg session\n"); 675199540Sjhb callout_stop(&sc->my_autoneg_timer); 676199540Sjhb sc->my_autoneg = sc->my_want_auto = 0; 67793746Sjulian bmcr = my_phy_readreg(sc, PHY_BMCR); 67893746Sjulian bmcr &= ~PHY_BMCR_AUTONEGENBL; 67993746Sjulian my_phy_writereg(sc, PHY_BMCR, bmcr); 68093746Sjulian } 681162321Sglebius device_printf(sc->my_dev, "selecting MII, "); 68293746Sjulian bmcr = my_phy_readreg(sc, PHY_BMCR); 68393746Sjulian bmcr &= ~(PHY_BMCR_AUTONEGENBL | PHY_BMCR_SPEEDSEL | PHY_BMCR_1000 | 68493746Sjulian PHY_BMCR_DUPLEX | PHY_BMCR_LOOPBK); 68594863Sjulian 68694863Sjulian#if 0 /* this version did not support 1000M, */ 68795673Sphk if (IFM_SUBTYPE(media) == IFM_1000_T) { 68893746Sjulian printf("1000Mbps/T4, half-duplex\n"); 68993746Sjulian bmcr &= ~PHY_BMCR_SPEEDSEL; 69093746Sjulian bmcr &= ~PHY_BMCR_DUPLEX; 69193746Sjulian bmcr |= PHY_BMCR_1000; 69293746Sjulian } 69393746Sjulian#endif 69493746Sjulian if (IFM_SUBTYPE(media) == IFM_100_T4) { 69593746Sjulian printf("100Mbps/T4, half-duplex\n"); 69693746Sjulian bmcr |= PHY_BMCR_SPEEDSEL; 69793746Sjulian bmcr &= ~PHY_BMCR_DUPLEX; 69893746Sjulian } 69993746Sjulian if (IFM_SUBTYPE(media) == IFM_100_TX) { 70093746Sjulian printf("100Mbps, "); 70193746Sjulian bmcr |= PHY_BMCR_SPEEDSEL; 70293746Sjulian } 70393746Sjulian if (IFM_SUBTYPE(media) == IFM_10_T) { 70493746Sjulian printf("10Mbps, "); 70593746Sjulian bmcr &= ~PHY_BMCR_SPEEDSEL; 70693746Sjulian } 70793746Sjulian if ((media & IFM_GMASK) == IFM_FDX) { 70893746Sjulian printf("full duplex\n"); 70993746Sjulian bmcr |= PHY_BMCR_DUPLEX; 71093746Sjulian } else { 71193746Sjulian printf("half duplex\n"); 71293746Sjulian bmcr &= ~PHY_BMCR_DUPLEX; 71393746Sjulian } 71493746Sjulian my_phy_writereg(sc, PHY_BMCR, bmcr); 71593746Sjulian my_setcfg(sc, bmcr); 71693746Sjulian return; 71793746Sjulian} 71893746Sjulian 71993746Sjulian/* 72093746Sjulian * The Myson manual states that in order to fiddle with the 'full-duplex' and 72193746Sjulian * '100Mbps' bits in the netconfig register, we first have to put the 72293746Sjulian * transmit and/or receive logic in the idle state. 72393746Sjulian */ 72493746Sjulianstatic void 72593746Sjulianmy_setcfg(struct my_softc * sc, int bmcr) 72693746Sjulian{ 72793746Sjulian int i, restart = 0; 72893746Sjulian 729149151Sjhb MY_LOCK_ASSERT(sc); 73093746Sjulian if (CSR_READ_4(sc, MY_TCRRCR) & (MY_TE | MY_RE)) { 73193746Sjulian restart = 1; 73293746Sjulian MY_CLRBIT(sc, MY_TCRRCR, (MY_TE | MY_RE)); 73393746Sjulian for (i = 0; i < MY_TIMEOUT; i++) { 73493746Sjulian DELAY(10); 73593746Sjulian if (!(CSR_READ_4(sc, MY_TCRRCR) & 73693746Sjulian (MY_TXRUN | MY_RXRUN))) 73793746Sjulian break; 73893746Sjulian } 73993746Sjulian if (i == MY_TIMEOUT) 740162321Sglebius device_printf(sc->my_dev, 741148945Sjhb "failed to force tx and rx to idle \n"); 74293746Sjulian } 74393746Sjulian MY_CLRBIT(sc, MY_TCRRCR, MY_PS1000); 74493746Sjulian MY_CLRBIT(sc, MY_TCRRCR, MY_PS10); 74593746Sjulian if (bmcr & PHY_BMCR_1000) 74693746Sjulian MY_SETBIT(sc, MY_TCRRCR, MY_PS1000); 74793746Sjulian else if (!(bmcr & PHY_BMCR_SPEEDSEL)) 74893746Sjulian MY_SETBIT(sc, MY_TCRRCR, MY_PS10); 74993746Sjulian if (bmcr & PHY_BMCR_DUPLEX) 75093746Sjulian MY_SETBIT(sc, MY_TCRRCR, MY_FD); 75193746Sjulian else 75293746Sjulian MY_CLRBIT(sc, MY_TCRRCR, MY_FD); 75393746Sjulian if (restart) 75493746Sjulian MY_SETBIT(sc, MY_TCRRCR, MY_TE | MY_RE); 75593746Sjulian return; 75693746Sjulian} 75793746Sjulian 75893746Sjulianstatic void 75993746Sjulianmy_reset(struct my_softc * sc) 76093746Sjulian{ 76193746Sjulian register int i; 76293746Sjulian 763149151Sjhb MY_LOCK_ASSERT(sc); 76493746Sjulian MY_SETBIT(sc, MY_BCR, MY_SWR); 76593746Sjulian for (i = 0; i < MY_TIMEOUT; i++) { 76693746Sjulian DELAY(10); 76793746Sjulian if (!(CSR_READ_4(sc, MY_BCR) & MY_SWR)) 76893746Sjulian break; 76993746Sjulian } 77093746Sjulian if (i == MY_TIMEOUT) 771162321Sglebius device_printf(sc->my_dev, "reset never completed!\n"); 77293746Sjulian 77393746Sjulian /* Wait a little while for the chip to get its brains in order. */ 77493746Sjulian DELAY(1000); 77593746Sjulian return; 77693746Sjulian} 77793746Sjulian 77893746Sjulian/* 77993746Sjulian * Probe for a Myson chip. Check the PCI vendor and device IDs against our 78093746Sjulian * list and return a device name if we find a match. 78193746Sjulian */ 78293746Sjulianstatic int 78393746Sjulianmy_probe(device_t dev) 78493746Sjulian{ 78593746Sjulian struct my_type *t; 78693746Sjulian 78793746Sjulian t = my_devs; 78893746Sjulian while (t->my_name != NULL) { 78993746Sjulian if ((pci_get_vendor(dev) == t->my_vid) && 79093746Sjulian (pci_get_device(dev) == t->my_did)) { 79193746Sjulian device_set_desc(dev, t->my_name); 79293746Sjulian my_info_tmp = t; 793143158Simp return (BUS_PROBE_DEFAULT); 79493746Sjulian } 79593746Sjulian t++; 79693746Sjulian } 79793746Sjulian return (ENXIO); 79893746Sjulian} 79993746Sjulian 80093746Sjulian/* 80193746Sjulian * Attach the interface. Allocate softc structures, do ifmedia setup and 80293746Sjulian * ethernet/BPF attach. 80393746Sjulian */ 80493746Sjulianstatic int 80593746Sjulianmy_attach(device_t dev) 80693746Sjulian{ 807149151Sjhb int i; 80893746Sjulian u_char eaddr[ETHER_ADDR_LEN]; 809148946Sjhb u_int32_t iobase; 81093746Sjulian struct my_softc *sc; 81193746Sjulian struct ifnet *ifp; 81293746Sjulian int media = IFM_ETHER | IFM_100_TX | IFM_FDX; 81393746Sjulian unsigned int round; 81493746Sjulian caddr_t roundptr; 81593746Sjulian struct my_type *p; 81693746Sjulian u_int16_t phy_vid, phy_did, phy_sts = 0; 817148945Sjhb int rid, error = 0; 81893746Sjulian 81993746Sjulian sc = device_get_softc(dev); 820162321Sglebius sc->my_dev = dev; 82195803Sjulian mtx_init(&sc->my_mtx, device_get_nameunit(dev), MTX_NETWORK_LOCK, 822149151Sjhb MTX_DEF); 823199540Sjhb callout_init_mtx(&sc->my_autoneg_timer, &sc->my_mtx, 0); 824199540Sjhb callout_init_mtx(&sc->my_watchdog, &sc->my_mtx, 0); 82593746Sjulian 82693746Sjulian /* 82793746Sjulian * Map control/status registers. 82893746Sjulian */ 829148946Sjhb pci_enable_busmaster(dev); 83093746Sjulian 83193746Sjulian if (my_info_tmp->my_did == MTD800ID) { 83293746Sjulian iobase = pci_read_config(dev, MY_PCI_LOIO, 4); 83393746Sjulian if (iobase & 0x300) 83493746Sjulian MY_USEIOSPACE = 0; 83593746Sjulian } 83693746Sjulian 83793746Sjulian rid = MY_RID; 838127135Snjl sc->my_res = bus_alloc_resource_any(dev, MY_RES, &rid, RF_ACTIVE); 83993746Sjulian 84093746Sjulian if (sc->my_res == NULL) { 841148945Sjhb device_printf(dev, "couldn't map ports/memory\n"); 84293746Sjulian error = ENXIO; 843149151Sjhb goto destroy_mutex; 84493746Sjulian } 84593746Sjulian sc->my_btag = rman_get_bustag(sc->my_res); 84693746Sjulian sc->my_bhandle = rman_get_bushandle(sc->my_res); 84793746Sjulian 84893746Sjulian rid = 0; 849127135Snjl sc->my_irq = bus_alloc_resource_any(dev, SYS_RES_IRQ, &rid, 850127135Snjl RF_SHAREABLE | RF_ACTIVE); 85193746Sjulian 85293746Sjulian if (sc->my_irq == NULL) { 853148945Sjhb device_printf(dev, "couldn't map interrupt\n"); 85493746Sjulian error = ENXIO; 855149151Sjhb goto release_io; 85693746Sjulian } 85793746Sjulian 85893746Sjulian sc->my_info = my_info_tmp; 85993746Sjulian 86093746Sjulian /* Reset the adapter. */ 861149151Sjhb MY_LOCK(sc); 86293746Sjulian my_reset(sc); 863149151Sjhb MY_UNLOCK(sc); 86493746Sjulian 86593746Sjulian /* 86693746Sjulian * Get station address 86793746Sjulian */ 86893746Sjulian for (i = 0; i < ETHER_ADDR_LEN; ++i) 86993746Sjulian eaddr[i] = CSR_READ_1(sc, MY_PAR0 + i); 87093746Sjulian 87193746Sjulian sc->my_ldata_ptr = malloc(sizeof(struct my_list_data) + 8, 87293746Sjulian M_DEVBUF, M_NOWAIT); 87393746Sjulian if (sc->my_ldata_ptr == NULL) { 874148945Sjhb device_printf(dev, "no memory for list buffers!\n"); 87593746Sjulian error = ENXIO; 876149151Sjhb goto release_irq; 87793746Sjulian } 87893746Sjulian sc->my_ldata = (struct my_list_data *) sc->my_ldata_ptr; 879106588Sjhb round = (uintptr_t)sc->my_ldata_ptr & 0xF; 88093746Sjulian roundptr = sc->my_ldata_ptr; 88193746Sjulian for (i = 0; i < 8; i++) { 88293746Sjulian if (round % 8) { 88393746Sjulian round++; 88493746Sjulian roundptr++; 88593746Sjulian } else 88693746Sjulian break; 88793746Sjulian } 88893746Sjulian sc->my_ldata = (struct my_list_data *) roundptr; 88993746Sjulian bzero(sc->my_ldata, sizeof(struct my_list_data)); 89093746Sjulian 891147256Sbrooks ifp = sc->my_ifp = if_alloc(IFT_ETHER); 892147256Sbrooks if (ifp == NULL) { 893147256Sbrooks device_printf(dev, "can not if_alloc()\n"); 894147256Sbrooks error = ENOSPC; 895149151Sjhb goto free_ldata; 896147256Sbrooks } 89793746Sjulian ifp->if_softc = sc; 898121816Sbrooks if_initname(ifp, device_get_name(dev), device_get_unit(dev)); 89993746Sjulian ifp->if_mtu = ETHERMTU; 90093746Sjulian ifp->if_flags = IFF_BROADCAST | IFF_SIMPLEX | IFF_MULTICAST; 90193746Sjulian ifp->if_ioctl = my_ioctl; 90293746Sjulian ifp->if_start = my_start; 90393746Sjulian ifp->if_init = my_init; 90493746Sjulian ifp->if_baudrate = 10000000; 905207554Ssobomax IFQ_SET_MAXLEN(&ifp->if_snd, ifqmaxlen); 906207554Ssobomax ifp->if_snd.ifq_drv_maxlen = ifqmaxlen; 907159291Sbrueffer IFQ_SET_READY(&ifp->if_snd); 90893746Sjulian 90993746Sjulian if (sc->my_info->my_did == MTD803ID) 91093746Sjulian sc->my_pinfo = my_phys; 91193746Sjulian else { 91293746Sjulian if (bootverbose) 913148945Sjhb device_printf(dev, "probing for a PHY\n"); 914149151Sjhb MY_LOCK(sc); 91593746Sjulian for (i = MY_PHYADDR_MIN; i < MY_PHYADDR_MAX + 1; i++) { 91693746Sjulian if (bootverbose) 917148945Sjhb device_printf(dev, "checking address: %d\n", i); 91893746Sjulian sc->my_phy_addr = i; 91993746Sjulian phy_sts = my_phy_readreg(sc, PHY_BMSR); 92093746Sjulian if ((phy_sts != 0) && (phy_sts != 0xffff)) 92193746Sjulian break; 92293746Sjulian else 92393746Sjulian phy_sts = 0; 92493746Sjulian } 92593746Sjulian if (phy_sts) { 92693746Sjulian phy_vid = my_phy_readreg(sc, PHY_VENID); 92793746Sjulian phy_did = my_phy_readreg(sc, PHY_DEVID); 92893746Sjulian if (bootverbose) { 929148945Sjhb device_printf(dev, "found PHY at address %d, ", 930148945Sjhb sc->my_phy_addr); 93193746Sjulian printf("vendor id: %x device id: %x\n", 93293746Sjulian phy_vid, phy_did); 93393746Sjulian } 93493746Sjulian p = my_phys; 93593746Sjulian while (p->my_vid) { 93693746Sjulian if (phy_vid == p->my_vid) { 93793746Sjulian sc->my_pinfo = p; 93893746Sjulian break; 93993746Sjulian } 94093746Sjulian p++; 94193746Sjulian } 94293746Sjulian if (sc->my_pinfo == NULL) 94393746Sjulian sc->my_pinfo = &my_phys[PHY_UNKNOWN]; 94493746Sjulian if (bootverbose) 945148945Sjhb device_printf(dev, "PHY type: %s\n", 946148945Sjhb sc->my_pinfo->my_name); 94793746Sjulian } else { 948149151Sjhb MY_UNLOCK(sc); 949148945Sjhb device_printf(dev, "MII without any phy!\n"); 95093746Sjulian error = ENXIO; 951149151Sjhb goto free_if; 95293746Sjulian } 953149151Sjhb MY_UNLOCK(sc); 95493746Sjulian } 95593746Sjulian 95693746Sjulian /* Do ifmedia setup. */ 95793746Sjulian ifmedia_init(&sc->ifmedia, 0, my_ifmedia_upd, my_ifmedia_sts); 958149151Sjhb MY_LOCK(sc); 95993746Sjulian my_getmode_mii(sc); 96093746Sjulian my_autoneg_mii(sc, MY_FLAG_FORCEDELAY, 1); 96193746Sjulian media = sc->ifmedia.ifm_media; 96293746Sjulian my_stop(sc); 963149151Sjhb MY_UNLOCK(sc); 96493746Sjulian ifmedia_set(&sc->ifmedia, media); 96593746Sjulian 966106937Ssam ether_ifattach(ifp, eaddr); 967149151Sjhb 968149151Sjhb error = bus_setup_intr(dev, sc->my_irq, INTR_TYPE_NET | INTR_MPSAFE, 969166901Spiso NULL, my_intr, sc, &sc->my_intrhand); 970149151Sjhb 971149151Sjhb if (error) { 972149151Sjhb device_printf(dev, "couldn't set up irq\n"); 973149151Sjhb goto detach_if; 974149151Sjhb } 97593746Sjulian 97693746Sjulian return (0); 97793746Sjulian 978149151Sjhbdetach_if: 979149151Sjhb ether_ifdetach(ifp); 980149151Sjhbfree_if: 981149151Sjhb if_free(ifp); 982149151Sjhbfree_ldata: 983149151Sjhb free(sc->my_ldata_ptr, M_DEVBUF); 984149151Sjhbrelease_irq: 985149151Sjhb bus_release_resource(dev, SYS_RES_IRQ, 0, sc->my_irq); 986149151Sjhbrelease_io: 987149151Sjhb bus_release_resource(dev, MY_RES, MY_RID, sc->my_res); 988149151Sjhbdestroy_mutex: 98993746Sjulian mtx_destroy(&sc->my_mtx); 99093746Sjulian return (error); 99193746Sjulian} 99293746Sjulian 99393746Sjulianstatic int 99493746Sjulianmy_detach(device_t dev) 99593746Sjulian{ 99693746Sjulian struct my_softc *sc; 99793746Sjulian struct ifnet *ifp; 99893746Sjulian 99993746Sjulian sc = device_get_softc(dev); 1000199540Sjhb ifp = sc->my_ifp; 1001199540Sjhb ether_ifdetach(ifp); 100293746Sjulian MY_LOCK(sc); 1003149151Sjhb my_stop(sc); 1004149151Sjhb MY_UNLOCK(sc); 1005149151Sjhb bus_teardown_intr(dev, sc->my_irq, sc->my_intrhand); 1006199540Sjhb callout_drain(&sc->my_watchdog); 1007199540Sjhb callout_drain(&sc->my_autoneg_timer); 1008149151Sjhb 1009147256Sbrooks if_free(ifp); 1010149151Sjhb free(sc->my_ldata_ptr, M_DEVBUF); 101193746Sjulian 101293746Sjulian bus_release_resource(dev, SYS_RES_IRQ, 0, sc->my_irq); 101393746Sjulian bus_release_resource(dev, MY_RES, MY_RID, sc->my_res); 101493746Sjulian mtx_destroy(&sc->my_mtx); 101593746Sjulian return (0); 101693746Sjulian} 101793746Sjulian 101893746Sjulian 101993746Sjulian/* 102093746Sjulian * Initialize the transmit descriptors. 102193746Sjulian */ 102293746Sjulianstatic int 102393746Sjulianmy_list_tx_init(struct my_softc * sc) 102493746Sjulian{ 102593746Sjulian struct my_chain_data *cd; 102693746Sjulian struct my_list_data *ld; 102793746Sjulian int i; 102893746Sjulian 1029149151Sjhb MY_LOCK_ASSERT(sc); 103093746Sjulian cd = &sc->my_cdata; 103193746Sjulian ld = sc->my_ldata; 103293746Sjulian for (i = 0; i < MY_TX_LIST_CNT; i++) { 103393746Sjulian cd->my_tx_chain[i].my_ptr = &ld->my_tx_list[i]; 103493746Sjulian if (i == (MY_TX_LIST_CNT - 1)) 103593746Sjulian cd->my_tx_chain[i].my_nextdesc = &cd->my_tx_chain[0]; 103693746Sjulian else 103793746Sjulian cd->my_tx_chain[i].my_nextdesc = 103893746Sjulian &cd->my_tx_chain[i + 1]; 103993746Sjulian } 104093746Sjulian cd->my_tx_free = &cd->my_tx_chain[0]; 104193746Sjulian cd->my_tx_tail = cd->my_tx_head = NULL; 104293746Sjulian return (0); 104393746Sjulian} 104493746Sjulian 104593746Sjulian/* 104693746Sjulian * Initialize the RX descriptors and allocate mbufs for them. Note that we 104793746Sjulian * arrange the descriptors in a closed ring, so that the last descriptor 104893746Sjulian * points back to the first. 104993746Sjulian */ 105093746Sjulianstatic int 105193746Sjulianmy_list_rx_init(struct my_softc * sc) 105293746Sjulian{ 105393746Sjulian struct my_chain_data *cd; 105493746Sjulian struct my_list_data *ld; 105593746Sjulian int i; 105693746Sjulian 1057149151Sjhb MY_LOCK_ASSERT(sc); 105893746Sjulian cd = &sc->my_cdata; 105993746Sjulian ld = sc->my_ldata; 106093746Sjulian for (i = 0; i < MY_RX_LIST_CNT; i++) { 106193746Sjulian cd->my_rx_chain[i].my_ptr = 106293746Sjulian (struct my_desc *) & ld->my_rx_list[i]; 106397641Sjulian if (my_newbuf(sc, &cd->my_rx_chain[i]) == ENOBUFS) { 106497641Sjulian MY_UNLOCK(sc); 106593746Sjulian return (ENOBUFS); 106697641Sjulian } 106793746Sjulian if (i == (MY_RX_LIST_CNT - 1)) { 106893746Sjulian cd->my_rx_chain[i].my_nextdesc = &cd->my_rx_chain[0]; 106993746Sjulian ld->my_rx_list[i].my_next = vtophys(&ld->my_rx_list[0]); 107093746Sjulian } else { 107193746Sjulian cd->my_rx_chain[i].my_nextdesc = 107293746Sjulian &cd->my_rx_chain[i + 1]; 107393746Sjulian ld->my_rx_list[i].my_next = 107493746Sjulian vtophys(&ld->my_rx_list[i + 1]); 107593746Sjulian } 107693746Sjulian } 107793746Sjulian cd->my_rx_head = &cd->my_rx_chain[0]; 107893746Sjulian return (0); 107993746Sjulian} 108093746Sjulian 108193746Sjulian/* 108293746Sjulian * Initialize an RX descriptor and attach an MBUF cluster. 108393746Sjulian */ 108493746Sjulianstatic int 108593746Sjulianmy_newbuf(struct my_softc * sc, struct my_chain_onefrag * c) 108693746Sjulian{ 108793746Sjulian struct mbuf *m_new = NULL; 108893746Sjulian 1089149151Sjhb MY_LOCK_ASSERT(sc); 1090111119Simp MGETHDR(m_new, M_DONTWAIT, MT_DATA); 109193746Sjulian if (m_new == NULL) { 1092162321Sglebius device_printf(sc->my_dev, 1093148945Sjhb "no memory for rx list -- packet dropped!\n"); 109493746Sjulian return (ENOBUFS); 109593746Sjulian } 1096111119Simp MCLGET(m_new, M_DONTWAIT); 109793746Sjulian if (!(m_new->m_flags & M_EXT)) { 1098162321Sglebius device_printf(sc->my_dev, 1099148945Sjhb "no memory for rx list -- packet dropped!\n"); 110093746Sjulian m_freem(m_new); 110193746Sjulian return (ENOBUFS); 110293746Sjulian } 110393746Sjulian c->my_mbuf = m_new; 110493746Sjulian c->my_ptr->my_data = vtophys(mtod(m_new, caddr_t)); 110593746Sjulian c->my_ptr->my_ctl = (MCLBYTES - 1) << MY_RBSShift; 110693746Sjulian c->my_ptr->my_status = MY_OWNByNIC; 110793746Sjulian return (0); 110893746Sjulian} 110993746Sjulian 111093746Sjulian/* 111193746Sjulian * A frame has been uploaded: pass the resulting mbuf chain up to the higher 111293746Sjulian * level protocols. 111393746Sjulian */ 111493746Sjulianstatic void 111593746Sjulianmy_rxeof(struct my_softc * sc) 111693746Sjulian{ 111793746Sjulian struct ether_header *eh; 111893746Sjulian struct mbuf *m; 111993746Sjulian struct ifnet *ifp; 112093746Sjulian struct my_chain_onefrag *cur_rx; 112193746Sjulian int total_len = 0; 112293746Sjulian u_int32_t rxstat; 112393746Sjulian 1124149151Sjhb MY_LOCK_ASSERT(sc); 1125147256Sbrooks ifp = sc->my_ifp; 112693746Sjulian while (!((rxstat = sc->my_cdata.my_rx_head->my_ptr->my_status) 112793746Sjulian & MY_OWNByNIC)) { 112893746Sjulian cur_rx = sc->my_cdata.my_rx_head; 112993746Sjulian sc->my_cdata.my_rx_head = cur_rx->my_nextdesc; 113093746Sjulian 113193746Sjulian if (rxstat & MY_ES) { /* error summary: give up this rx pkt */ 113293746Sjulian ifp->if_ierrors++; 113393746Sjulian cur_rx->my_ptr->my_status = MY_OWNByNIC; 113493746Sjulian continue; 113593746Sjulian } 113693746Sjulian /* No errors; receive the packet. */ 113793746Sjulian total_len = (rxstat & MY_FLNGMASK) >> MY_FLNGShift; 113893746Sjulian total_len -= ETHER_CRC_LEN; 113993746Sjulian 114093746Sjulian if (total_len < MINCLSIZE) { 114193746Sjulian m = m_devget(mtod(cur_rx->my_mbuf, char *), 114293746Sjulian total_len, 0, ifp, NULL); 114393746Sjulian cur_rx->my_ptr->my_status = MY_OWNByNIC; 114493746Sjulian if (m == NULL) { 114593746Sjulian ifp->if_ierrors++; 114693746Sjulian continue; 114793746Sjulian } 114893746Sjulian } else { 114993746Sjulian m = cur_rx->my_mbuf; 115093746Sjulian /* 115193746Sjulian * Try to conjure up a new mbuf cluster. If that 115293746Sjulian * fails, it means we have an out of memory condition 115393746Sjulian * and should leave the buffer in place and continue. 115493746Sjulian * This will result in a lost packet, but there's 115593746Sjulian * little else we can do in this situation. 115693746Sjulian */ 115793746Sjulian if (my_newbuf(sc, cur_rx) == ENOBUFS) { 115893746Sjulian ifp->if_ierrors++; 115993746Sjulian cur_rx->my_ptr->my_status = MY_OWNByNIC; 116093746Sjulian continue; 116193746Sjulian } 116293746Sjulian m->m_pkthdr.rcvif = ifp; 116393746Sjulian m->m_pkthdr.len = m->m_len = total_len; 116493746Sjulian } 116593746Sjulian ifp->if_ipackets++; 116693746Sjulian eh = mtod(m, struct ether_header *); 116793746Sjulian#if NBPFILTER > 0 116893746Sjulian /* 116993746Sjulian * Handle BPF listeners. Let the BPF user see the packet, but 117093746Sjulian * don't pass it up to the ether_input() layer unless it's a 117193746Sjulian * broadcast packet, multicast packet, matches our ethernet 117293746Sjulian * address or the interface is in promiscuous mode. 117393746Sjulian */ 1174165632Sjhb if (bpf_peers_present(ifp->if_bpf)) { 1175165640Sjhb bpf_mtap(ifp->if_bpf, m); 117693746Sjulian if (ifp->if_flags & IFF_PROMISC && 1177152315Sru (bcmp(eh->ether_dhost, IF_LLADDR(sc->my_ifp), 117893746Sjulian ETHER_ADDR_LEN) && 117993746Sjulian (eh->ether_dhost[0] & 1) == 0)) { 118093746Sjulian m_freem(m); 118193746Sjulian continue; 118293746Sjulian } 118393746Sjulian } 118493746Sjulian#endif 1185122689Ssam MY_UNLOCK(sc); 1186106937Ssam (*ifp->if_input)(ifp, m); 1187122689Ssam MY_LOCK(sc); 118893746Sjulian } 118993746Sjulian return; 119093746Sjulian} 119193746Sjulian 119293746Sjulian 119393746Sjulian/* 119493746Sjulian * A frame was downloaded to the chip. It's safe for us to clean up the list 119593746Sjulian * buffers. 119693746Sjulian */ 119793746Sjulianstatic void 119893746Sjulianmy_txeof(struct my_softc * sc) 119993746Sjulian{ 120093746Sjulian struct my_chain *cur_tx; 120193746Sjulian struct ifnet *ifp; 120293746Sjulian 1203149151Sjhb MY_LOCK_ASSERT(sc); 1204147256Sbrooks ifp = sc->my_ifp; 120593746Sjulian /* Clear the timeout timer. */ 1206199540Sjhb sc->my_timer = 0; 120795939Sjulian if (sc->my_cdata.my_tx_head == NULL) { 120893746Sjulian return; 120995939Sjulian } 121093746Sjulian /* 121193746Sjulian * Go through our tx list and free mbufs for those frames that have 121293746Sjulian * been transmitted. 121393746Sjulian */ 121493746Sjulian while (sc->my_cdata.my_tx_head->my_mbuf != NULL) { 121593746Sjulian u_int32_t txstat; 121693746Sjulian 121793746Sjulian cur_tx = sc->my_cdata.my_tx_head; 121893746Sjulian txstat = MY_TXSTATUS(cur_tx); 121993746Sjulian if ((txstat & MY_OWNByNIC) || txstat == MY_UNSENT) 122093746Sjulian break; 122193746Sjulian if (!(CSR_READ_4(sc, MY_TCRRCR) & MY_Enhanced)) { 122293746Sjulian if (txstat & MY_TXERR) { 122393746Sjulian ifp->if_oerrors++; 122493746Sjulian if (txstat & MY_EC) /* excessive collision */ 122593746Sjulian ifp->if_collisions++; 122693746Sjulian if (txstat & MY_LC) /* late collision */ 122793746Sjulian ifp->if_collisions++; 122893746Sjulian } 122993746Sjulian ifp->if_collisions += (txstat & MY_NCRMASK) >> 123093746Sjulian MY_NCRShift; 123193746Sjulian } 123293746Sjulian ifp->if_opackets++; 123393746Sjulian m_freem(cur_tx->my_mbuf); 123493746Sjulian cur_tx->my_mbuf = NULL; 123593746Sjulian if (sc->my_cdata.my_tx_head == sc->my_cdata.my_tx_tail) { 123693746Sjulian sc->my_cdata.my_tx_head = NULL; 123793746Sjulian sc->my_cdata.my_tx_tail = NULL; 123893746Sjulian break; 123993746Sjulian } 124093746Sjulian sc->my_cdata.my_tx_head = cur_tx->my_nextdesc; 124193746Sjulian } 124293746Sjulian if (CSR_READ_4(sc, MY_TCRRCR) & MY_Enhanced) { 124393746Sjulian ifp->if_collisions += (CSR_READ_4(sc, MY_TSR) & MY_NCRMask); 124493746Sjulian } 124593746Sjulian return; 124693746Sjulian} 124793746Sjulian 124893746Sjulian/* 124993746Sjulian * TX 'end of channel' interrupt handler. 125093746Sjulian */ 125193746Sjulianstatic void 125293746Sjulianmy_txeoc(struct my_softc * sc) 125393746Sjulian{ 125493746Sjulian struct ifnet *ifp; 125593746Sjulian 1256149151Sjhb MY_LOCK_ASSERT(sc); 1257147256Sbrooks ifp = sc->my_ifp; 1258199540Sjhb sc->my_timer = 0; 125993746Sjulian if (sc->my_cdata.my_tx_head == NULL) { 1260148887Srwatson ifp->if_drv_flags &= ~IFF_DRV_OACTIVE; 126193746Sjulian sc->my_cdata.my_tx_tail = NULL; 126293746Sjulian if (sc->my_want_auto) 126393746Sjulian my_autoneg_mii(sc, MY_FLAG_SCHEDDELAY, 1); 126493746Sjulian } else { 126593746Sjulian if (MY_TXOWN(sc->my_cdata.my_tx_head) == MY_UNSENT) { 126693746Sjulian MY_TXOWN(sc->my_cdata.my_tx_head) = MY_OWNByNIC; 1267199540Sjhb sc->my_timer = 5; 126893746Sjulian CSR_WRITE_4(sc, MY_TXPDR, 0xFFFFFFFF); 126993746Sjulian } 127093746Sjulian } 127193746Sjulian return; 127293746Sjulian} 127393746Sjulian 127493746Sjulianstatic void 127593746Sjulianmy_intr(void *arg) 127693746Sjulian{ 127793746Sjulian struct my_softc *sc; 127893746Sjulian struct ifnet *ifp; 127993746Sjulian u_int32_t status; 128093746Sjulian 128193746Sjulian sc = arg; 128293746Sjulian MY_LOCK(sc); 1283147256Sbrooks ifp = sc->my_ifp; 128493746Sjulian if (!(ifp->if_flags & IFF_UP)) { 128593746Sjulian MY_UNLOCK(sc); 128693746Sjulian return; 128793746Sjulian } 128893746Sjulian /* Disable interrupts. */ 128993746Sjulian CSR_WRITE_4(sc, MY_IMR, 0x00000000); 129093746Sjulian 129193746Sjulian for (;;) { 129293746Sjulian status = CSR_READ_4(sc, MY_ISR); 129393746Sjulian status &= MY_INTRS; 129493746Sjulian if (status) 129593746Sjulian CSR_WRITE_4(sc, MY_ISR, status); 129693746Sjulian else 129793746Sjulian break; 129893746Sjulian 129993746Sjulian if (status & MY_RI) /* receive interrupt */ 130093746Sjulian my_rxeof(sc); 130193746Sjulian 130293746Sjulian if ((status & MY_RBU) || (status & MY_RxErr)) { 130393746Sjulian /* rx buffer unavailable or rx error */ 130493746Sjulian ifp->if_ierrors++; 130593746Sjulian#ifdef foo 130693746Sjulian my_stop(sc); 130793746Sjulian my_reset(sc); 1308149151Sjhb my_init_locked(sc); 130993746Sjulian#endif 131093746Sjulian } 131193746Sjulian if (status & MY_TI) /* tx interrupt */ 131293746Sjulian my_txeof(sc); 131393746Sjulian if (status & MY_ETI) /* tx early interrupt */ 131493746Sjulian my_txeof(sc); 131593746Sjulian if (status & MY_TBU) /* tx buffer unavailable */ 131693746Sjulian my_txeoc(sc); 131794863Sjulian 131894863Sjulian#if 0 /* 90/1/18 delete */ 131994863Sjulian if (status & MY_FBE) { 132094863Sjulian my_reset(sc); 1321149151Sjhb my_init_locked(sc); 132294863Sjulian } 132394863Sjulian#endif 132494863Sjulian 132593746Sjulian } 132693746Sjulian 132793746Sjulian /* Re-enable interrupts. */ 132893746Sjulian CSR_WRITE_4(sc, MY_IMR, MY_INTRS); 1329159291Sbrueffer if (!IFQ_DRV_IS_EMPTY(&ifp->if_snd)) 1330149151Sjhb my_start_locked(ifp); 133193746Sjulian MY_UNLOCK(sc); 133293746Sjulian return; 133393746Sjulian} 133493746Sjulian 133593746Sjulian/* 133693746Sjulian * Encapsulate an mbuf chain in a descriptor by coupling the mbuf data 133793746Sjulian * pointers to the fragment pointers. 133893746Sjulian */ 133993746Sjulianstatic int 134093746Sjulianmy_encap(struct my_softc * sc, struct my_chain * c, struct mbuf * m_head) 134193746Sjulian{ 134293746Sjulian struct my_desc *f = NULL; 134393746Sjulian int total_len; 134493746Sjulian struct mbuf *m, *m_new = NULL; 134593746Sjulian 1346149151Sjhb MY_LOCK_ASSERT(sc); 134793746Sjulian /* calculate the total tx pkt length */ 134893746Sjulian total_len = 0; 134993746Sjulian for (m = m_head; m != NULL; m = m->m_next) 135093746Sjulian total_len += m->m_len; 135193746Sjulian /* 135293746Sjulian * Start packing the mbufs in this chain into the fragment pointers. 135393746Sjulian * Stop when we run out of fragments or hit the end of the mbuf 135493746Sjulian * chain. 135593746Sjulian */ 135693746Sjulian m = m_head; 1357111119Simp MGETHDR(m_new, M_DONTWAIT, MT_DATA); 135893746Sjulian if (m_new == NULL) { 1359162321Sglebius device_printf(sc->my_dev, "no memory for tx list"); 136093746Sjulian return (1); 136193746Sjulian } 136293746Sjulian if (m_head->m_pkthdr.len > MHLEN) { 1363111119Simp MCLGET(m_new, M_DONTWAIT); 136493746Sjulian if (!(m_new->m_flags & M_EXT)) { 136593746Sjulian m_freem(m_new); 1366162321Sglebius device_printf(sc->my_dev, "no memory for tx list"); 136793746Sjulian return (1); 136893746Sjulian } 136993746Sjulian } 137093746Sjulian m_copydata(m_head, 0, m_head->m_pkthdr.len, mtod(m_new, caddr_t)); 137193746Sjulian m_new->m_pkthdr.len = m_new->m_len = m_head->m_pkthdr.len; 137293746Sjulian m_freem(m_head); 137393746Sjulian m_head = m_new; 137493746Sjulian f = &c->my_ptr->my_frag[0]; 137593746Sjulian f->my_status = 0; 137693746Sjulian f->my_data = vtophys(mtod(m_new, caddr_t)); 137793746Sjulian total_len = m_new->m_len; 137893746Sjulian f->my_ctl = MY_TXFD | MY_TXLD | MY_CRCEnable | MY_PADEnable; 137993746Sjulian f->my_ctl |= total_len << MY_PKTShift; /* pkt size */ 138093746Sjulian f->my_ctl |= total_len; /* buffer size */ 138194904Sjulian /* 89/12/29 add, for mtd891 *//* [ 89? ] */ 138293746Sjulian if (sc->my_info->my_did == MTD891ID) 138393746Sjulian f->my_ctl |= MY_ETIControl | MY_RetryTxLC; 138493746Sjulian c->my_mbuf = m_head; 138593746Sjulian c->my_lastdesc = 0; 138693746Sjulian MY_TXNEXT(c) = vtophys(&c->my_nextdesc->my_ptr->my_frag[0]); 138793746Sjulian return (0); 138893746Sjulian} 138993746Sjulian 139093746Sjulian/* 139193746Sjulian * Main transmit routine. To avoid having to do mbuf copies, we put pointers 139293746Sjulian * to the mbuf data regions directly in the transmit lists. We also save a 139393746Sjulian * copy of the pointers since the transmit list fragment pointers are 139493746Sjulian * physical addresses. 139593746Sjulian */ 139693746Sjulianstatic void 139793746Sjulianmy_start(struct ifnet * ifp) 139893746Sjulian{ 139993746Sjulian struct my_softc *sc; 1400149151Sjhb 1401149151Sjhb sc = ifp->if_softc; 1402149151Sjhb MY_LOCK(sc); 1403149151Sjhb my_start_locked(ifp); 1404149151Sjhb MY_UNLOCK(sc); 1405149151Sjhb} 1406149151Sjhb 1407149151Sjhbstatic void 1408149151Sjhbmy_start_locked(struct ifnet * ifp) 1409149151Sjhb{ 1410149151Sjhb struct my_softc *sc; 141193746Sjulian struct mbuf *m_head = NULL; 141293746Sjulian struct my_chain *cur_tx = NULL, *start_tx; 141393746Sjulian 141493746Sjulian sc = ifp->if_softc; 1415149151Sjhb MY_LOCK_ASSERT(sc); 141693746Sjulian if (sc->my_autoneg) { 141793746Sjulian sc->my_tx_pend = 1; 141893746Sjulian return; 141993746Sjulian } 142093746Sjulian /* 142193746Sjulian * Check for an available queue slot. If there are none, punt. 142293746Sjulian */ 142393746Sjulian if (sc->my_cdata.my_tx_free->my_mbuf != NULL) { 1424148887Srwatson ifp->if_drv_flags |= IFF_DRV_OACTIVE; 142593746Sjulian return; 142693746Sjulian } 142793746Sjulian start_tx = sc->my_cdata.my_tx_free; 142893746Sjulian while (sc->my_cdata.my_tx_free->my_mbuf == NULL) { 1429159291Sbrueffer IFQ_DRV_DEQUEUE(&ifp->if_snd, m_head); 143093746Sjulian if (m_head == NULL) 143193746Sjulian break; 143293746Sjulian 143393746Sjulian /* Pick a descriptor off the free list. */ 143493746Sjulian cur_tx = sc->my_cdata.my_tx_free; 143593746Sjulian sc->my_cdata.my_tx_free = cur_tx->my_nextdesc; 143693746Sjulian 143793746Sjulian /* Pack the data into the descriptor. */ 143893746Sjulian my_encap(sc, cur_tx, m_head); 143993746Sjulian 144093746Sjulian if (cur_tx != start_tx) 144193746Sjulian MY_TXOWN(cur_tx) = MY_OWNByNIC; 144293746Sjulian#if NBPFILTER > 0 144393746Sjulian /* 144493746Sjulian * If there's a BPF listener, bounce a copy of this frame to 144593746Sjulian * him. 144693746Sjulian */ 1447106937Ssam BPF_MTAP(ifp, cur_tx->my_mbuf); 144893746Sjulian#endif 144993746Sjulian } 145093746Sjulian /* 145193746Sjulian * If there are no packets queued, bail. 145293746Sjulian */ 145393746Sjulian if (cur_tx == NULL) { 145493746Sjulian return; 145593746Sjulian } 145693746Sjulian /* 145793746Sjulian * Place the request for the upload interrupt in the last descriptor 145893746Sjulian * in the chain. This way, if we're chaining several packets at once, 1459172568Skevlo * we'll only get an interrupt once for the whole chain rather than 146093746Sjulian * once for each packet. 146193746Sjulian */ 146293746Sjulian MY_TXCTL(cur_tx) |= MY_TXIC; 146393746Sjulian cur_tx->my_ptr->my_frag[0].my_ctl |= MY_TXIC; 146493746Sjulian sc->my_cdata.my_tx_tail = cur_tx; 146593746Sjulian if (sc->my_cdata.my_tx_head == NULL) 146693746Sjulian sc->my_cdata.my_tx_head = start_tx; 146793746Sjulian MY_TXOWN(start_tx) = MY_OWNByNIC; 146893746Sjulian CSR_WRITE_4(sc, MY_TXPDR, 0xFFFFFFFF); /* tx polling demand */ 146993746Sjulian 147093746Sjulian /* 147193746Sjulian * Set a timeout in case the chip goes out to lunch. 147293746Sjulian */ 1473199540Sjhb sc->my_timer = 5; 147493746Sjulian return; 147593746Sjulian} 147693746Sjulian 147793746Sjulianstatic void 147893746Sjulianmy_init(void *xsc) 147993746Sjulian{ 148093746Sjulian struct my_softc *sc = xsc; 1481149151Sjhb 1482149151Sjhb MY_LOCK(sc); 1483149151Sjhb my_init_locked(sc); 1484149151Sjhb MY_UNLOCK(sc); 1485149151Sjhb} 1486149151Sjhb 1487149151Sjhbstatic void 1488149151Sjhbmy_init_locked(struct my_softc *sc) 1489149151Sjhb{ 1490147256Sbrooks struct ifnet *ifp = sc->my_ifp; 149193746Sjulian u_int16_t phy_bmcr = 0; 149293746Sjulian 1493149151Sjhb MY_LOCK_ASSERT(sc); 149493746Sjulian if (sc->my_autoneg) { 149593746Sjulian return; 149693746Sjulian } 149793746Sjulian if (sc->my_pinfo != NULL) 149893746Sjulian phy_bmcr = my_phy_readreg(sc, PHY_BMCR); 149993746Sjulian /* 150093746Sjulian * Cancel pending I/O and free all RX/TX buffers. 150193746Sjulian */ 150293746Sjulian my_stop(sc); 150393746Sjulian my_reset(sc); 150493746Sjulian 150593746Sjulian /* 150693746Sjulian * Set cache alignment and burst length. 150793746Sjulian */ 150894863Sjulian#if 0 /* 89/9/1 modify, */ 150994863Sjulian CSR_WRITE_4(sc, MY_BCR, MY_RPBLE512); 151094863Sjulian CSR_WRITE_4(sc, MY_TCRRCR, MY_TFTSF); 151194863Sjulian#endif 151293746Sjulian CSR_WRITE_4(sc, MY_BCR, MY_PBL8); 151393746Sjulian CSR_WRITE_4(sc, MY_TCRRCR, MY_TFTSF | MY_RBLEN | MY_RPBLE512); 151493746Sjulian /* 151593746Sjulian * 89/12/29 add, for mtd891, 151693746Sjulian */ 151793746Sjulian if (sc->my_info->my_did == MTD891ID) { 151893746Sjulian MY_SETBIT(sc, MY_BCR, MY_PROG); 151993746Sjulian MY_SETBIT(sc, MY_TCRRCR, MY_Enhanced); 152093746Sjulian } 152193746Sjulian my_setcfg(sc, phy_bmcr); 152293746Sjulian /* Init circular RX list. */ 152393746Sjulian if (my_list_rx_init(sc) == ENOBUFS) { 1524162321Sglebius device_printf(sc->my_dev, "init failed: no memory for rx buffers\n"); 152593746Sjulian my_stop(sc); 152693746Sjulian return; 152793746Sjulian } 152893746Sjulian /* Init TX descriptors. */ 152993746Sjulian my_list_tx_init(sc); 153093746Sjulian 153193746Sjulian /* If we want promiscuous mode, set the allframes bit. */ 153293746Sjulian if (ifp->if_flags & IFF_PROMISC) 153393746Sjulian MY_SETBIT(sc, MY_TCRRCR, MY_PROM); 153493746Sjulian else 153593746Sjulian MY_CLRBIT(sc, MY_TCRRCR, MY_PROM); 153693746Sjulian 153793746Sjulian /* 153893746Sjulian * Set capture broadcast bit to capture broadcast frames. 153993746Sjulian */ 154093746Sjulian if (ifp->if_flags & IFF_BROADCAST) 154193746Sjulian MY_SETBIT(sc, MY_TCRRCR, MY_AB); 154293746Sjulian else 154393746Sjulian MY_CLRBIT(sc, MY_TCRRCR, MY_AB); 154493746Sjulian 154593746Sjulian /* 154693746Sjulian * Program the multicast filter, if necessary. 154793746Sjulian */ 154893746Sjulian my_setmulti(sc); 154993746Sjulian 155093746Sjulian /* 155193746Sjulian * Load the address of the RX list. 155293746Sjulian */ 155393746Sjulian MY_CLRBIT(sc, MY_TCRRCR, MY_RE); 155493746Sjulian CSR_WRITE_4(sc, MY_RXLBA, vtophys(&sc->my_ldata->my_rx_list[0])); 155593746Sjulian 155693746Sjulian /* 155793746Sjulian * Enable interrupts. 155893746Sjulian */ 155993746Sjulian CSR_WRITE_4(sc, MY_IMR, MY_INTRS); 156093746Sjulian CSR_WRITE_4(sc, MY_ISR, 0xFFFFFFFF); 156193746Sjulian 156293746Sjulian /* Enable receiver and transmitter. */ 156393746Sjulian MY_SETBIT(sc, MY_TCRRCR, MY_RE); 156493746Sjulian MY_CLRBIT(sc, MY_TCRRCR, MY_TE); 156593746Sjulian CSR_WRITE_4(sc, MY_TXLBA, vtophys(&sc->my_ldata->my_tx_list[0])); 156693746Sjulian MY_SETBIT(sc, MY_TCRRCR, MY_TE); 156793746Sjulian 156893746Sjulian /* Restore state of BMCR */ 156993746Sjulian if (sc->my_pinfo != NULL) 157093746Sjulian my_phy_writereg(sc, PHY_BMCR, phy_bmcr); 1571148887Srwatson ifp->if_drv_flags |= IFF_DRV_RUNNING; 1572148887Srwatson ifp->if_drv_flags &= ~IFF_DRV_OACTIVE; 1573199540Sjhb 1574199540Sjhb callout_reset(&sc->my_watchdog, hz, my_watchdog, sc); 157593746Sjulian return; 157693746Sjulian} 157793746Sjulian 157893746Sjulian/* 157993746Sjulian * Set media options. 158093746Sjulian */ 158193746Sjulian 158293746Sjulianstatic int 158393746Sjulianmy_ifmedia_upd(struct ifnet * ifp) 158493746Sjulian{ 158593746Sjulian struct my_softc *sc; 158693746Sjulian struct ifmedia *ifm; 158793746Sjulian 158893746Sjulian sc = ifp->if_softc; 158993746Sjulian MY_LOCK(sc); 159093746Sjulian ifm = &sc->ifmedia; 159193746Sjulian if (IFM_TYPE(ifm->ifm_media) != IFM_ETHER) { 159293746Sjulian MY_UNLOCK(sc); 159393746Sjulian return (EINVAL); 159493746Sjulian } 159593746Sjulian if (IFM_SUBTYPE(ifm->ifm_media) == IFM_AUTO) 159693746Sjulian my_autoneg_mii(sc, MY_FLAG_SCHEDDELAY, 1); 159793746Sjulian else 159893746Sjulian my_setmode_mii(sc, ifm->ifm_media); 159993746Sjulian MY_UNLOCK(sc); 160093746Sjulian return (0); 160193746Sjulian} 160293746Sjulian 160393746Sjulian/* 160493746Sjulian * Report current media status. 160593746Sjulian */ 160693746Sjulian 160793746Sjulianstatic void 160893746Sjulianmy_ifmedia_sts(struct ifnet * ifp, struct ifmediareq * ifmr) 160993746Sjulian{ 161093746Sjulian struct my_softc *sc; 161193746Sjulian u_int16_t advert = 0, ability = 0; 161293746Sjulian 161393746Sjulian sc = ifp->if_softc; 161493746Sjulian MY_LOCK(sc); 161593746Sjulian ifmr->ifm_active = IFM_ETHER; 161693746Sjulian if (!(my_phy_readreg(sc, PHY_BMCR) & PHY_BMCR_AUTONEGENBL)) { 161794863Sjulian#if 0 /* this version did not support 1000M, */ 161894863Sjulian if (my_phy_readreg(sc, PHY_BMCR) & PHY_BMCR_1000) 161994863Sjulian ifmr->ifm_active = IFM_ETHER | IFM_1000TX; 162094863Sjulian#endif 162193746Sjulian if (my_phy_readreg(sc, PHY_BMCR) & PHY_BMCR_SPEEDSEL) 162293746Sjulian ifmr->ifm_active = IFM_ETHER | IFM_100_TX; 162393746Sjulian else 162493746Sjulian ifmr->ifm_active = IFM_ETHER | IFM_10_T; 162593746Sjulian if (my_phy_readreg(sc, PHY_BMCR) & PHY_BMCR_DUPLEX) 162693746Sjulian ifmr->ifm_active |= IFM_FDX; 162793746Sjulian else 162893746Sjulian ifmr->ifm_active |= IFM_HDX; 162993746Sjulian 163093746Sjulian MY_UNLOCK(sc); 163193746Sjulian return; 163293746Sjulian } 163393746Sjulian ability = my_phy_readreg(sc, PHY_LPAR); 163493746Sjulian advert = my_phy_readreg(sc, PHY_ANAR); 163593746Sjulian 163694863Sjulian#if 0 /* this version did not support 1000M, */ 163793746Sjulian if (sc->my_pinfo->my_vid = MarvellPHYID0) { 163893746Sjulian ability2 = my_phy_readreg(sc, PHY_1000SR); 163993746Sjulian if (ability2 & PHY_1000SR_1000BTXFULL) { 164093746Sjulian advert = 0; 164193746Sjulian ability = 0; 164295673Sphk ifmr->ifm_active = IFM_ETHER|IFM_1000_T|IFM_FDX; 164393746Sjulian } else if (ability & PHY_1000SR_1000BTXHALF) { 164493746Sjulian advert = 0; 164593746Sjulian ability = 0; 164695673Sphk ifmr->ifm_active = IFM_ETHER|IFM_1000_T|IFM_HDX; 164793746Sjulian } 164893746Sjulian } 164993746Sjulian#endif 165093746Sjulian if (advert & PHY_ANAR_100BT4 && ability & PHY_ANAR_100BT4) 165193746Sjulian ifmr->ifm_active = IFM_ETHER | IFM_100_T4; 165293746Sjulian else if (advert & PHY_ANAR_100BTXFULL && ability & PHY_ANAR_100BTXFULL) 165393746Sjulian ifmr->ifm_active = IFM_ETHER | IFM_100_TX | IFM_FDX; 165493746Sjulian else if (advert & PHY_ANAR_100BTXHALF && ability & PHY_ANAR_100BTXHALF) 165593746Sjulian ifmr->ifm_active = IFM_ETHER | IFM_100_TX | IFM_HDX; 165693746Sjulian else if (advert & PHY_ANAR_10BTFULL && ability & PHY_ANAR_10BTFULL) 165793746Sjulian ifmr->ifm_active = IFM_ETHER | IFM_10_T | IFM_FDX; 165893746Sjulian else if (advert & PHY_ANAR_10BTHALF && ability & PHY_ANAR_10BTHALF) 165993746Sjulian ifmr->ifm_active = IFM_ETHER | IFM_10_T | IFM_HDX; 166093746Sjulian MY_UNLOCK(sc); 166193746Sjulian return; 166293746Sjulian} 166393746Sjulian 166493746Sjulianstatic int 166593746Sjulianmy_ioctl(struct ifnet * ifp, u_long command, caddr_t data) 166693746Sjulian{ 166793746Sjulian struct my_softc *sc = ifp->if_softc; 166893746Sjulian struct ifreq *ifr = (struct ifreq *) data; 1669149151Sjhb int error; 167093746Sjulian 167193746Sjulian switch (command) { 167293746Sjulian case SIOCSIFFLAGS: 1673149151Sjhb MY_LOCK(sc); 167493746Sjulian if (ifp->if_flags & IFF_UP) 1675149151Sjhb my_init_locked(sc); 1676148887Srwatson else if (ifp->if_drv_flags & IFF_DRV_RUNNING) 167793746Sjulian my_stop(sc); 1678149151Sjhb MY_UNLOCK(sc); 167993746Sjulian error = 0; 168093746Sjulian break; 168193746Sjulian case SIOCADDMULTI: 168293746Sjulian case SIOCDELMULTI: 1683149151Sjhb MY_LOCK(sc); 168493746Sjulian my_setmulti(sc); 1685149151Sjhb MY_UNLOCK(sc); 168693746Sjulian error = 0; 168793746Sjulian break; 168893746Sjulian case SIOCGIFMEDIA: 168993746Sjulian case SIOCSIFMEDIA: 169093746Sjulian error = ifmedia_ioctl(ifp, ifr, &sc->ifmedia, command); 169193746Sjulian break; 169293746Sjulian default: 1693106937Ssam error = ether_ioctl(ifp, command, data); 169493746Sjulian break; 169593746Sjulian } 169693746Sjulian return (error); 169793746Sjulian} 169893746Sjulian 169993746Sjulianstatic void 1700199540Sjhbmy_watchdog(void *arg) 170193746Sjulian{ 170293746Sjulian struct my_softc *sc; 1703199540Sjhb struct ifnet *ifp; 170493746Sjulian 1705199540Sjhb sc = arg; 1706199540Sjhb MY_LOCK_ASSERT(sc); 1707199540Sjhb callout_reset(&sc->my_watchdog, hz, my_watchdog, sc); 1708199540Sjhb if (sc->my_timer == 0 || --sc->my_timer > 0) 170993746Sjulian return; 1710199540Sjhb 1711199540Sjhb ifp = sc->my_ifp; 171293746Sjulian ifp->if_oerrors++; 1713148945Sjhb if_printf(ifp, "watchdog timeout\n"); 171493746Sjulian if (!(my_phy_readreg(sc, PHY_BMSR) & PHY_BMSR_LINKSTAT)) 1715148945Sjhb if_printf(ifp, "no carrier - transceiver cable problem?\n"); 171693746Sjulian my_stop(sc); 171793746Sjulian my_reset(sc); 1718149151Sjhb my_init_locked(sc); 1719159291Sbrueffer if (!IFQ_DRV_IS_EMPTY(&ifp->if_snd)) 1720149151Sjhb my_start_locked(ifp); 172193746Sjulian} 172293746Sjulian 172393746Sjulian 172493746Sjulian/* 172593746Sjulian * Stop the adapter and free any mbufs allocated to the RX and TX lists. 172693746Sjulian */ 172793746Sjulianstatic void 172893746Sjulianmy_stop(struct my_softc * sc) 172993746Sjulian{ 173093746Sjulian register int i; 173193746Sjulian struct ifnet *ifp; 173293746Sjulian 1733149151Sjhb MY_LOCK_ASSERT(sc); 1734147256Sbrooks ifp = sc->my_ifp; 173593746Sjulian 1736199540Sjhb callout_stop(&sc->my_autoneg_timer); 1737199540Sjhb callout_stop(&sc->my_watchdog); 1738199540Sjhb 173993746Sjulian MY_CLRBIT(sc, MY_TCRRCR, (MY_RE | MY_TE)); 174093746Sjulian CSR_WRITE_4(sc, MY_IMR, 0x00000000); 174193746Sjulian CSR_WRITE_4(sc, MY_TXLBA, 0x00000000); 174293746Sjulian CSR_WRITE_4(sc, MY_RXLBA, 0x00000000); 174393746Sjulian 174493746Sjulian /* 174593746Sjulian * Free data in the RX lists. 174693746Sjulian */ 174793746Sjulian for (i = 0; i < MY_RX_LIST_CNT; i++) { 174893746Sjulian if (sc->my_cdata.my_rx_chain[i].my_mbuf != NULL) { 174993746Sjulian m_freem(sc->my_cdata.my_rx_chain[i].my_mbuf); 175093746Sjulian sc->my_cdata.my_rx_chain[i].my_mbuf = NULL; 175193746Sjulian } 175293746Sjulian } 175393746Sjulian bzero((char *)&sc->my_ldata->my_rx_list, 175493746Sjulian sizeof(sc->my_ldata->my_rx_list)); 175593746Sjulian /* 175693746Sjulian * Free the TX list buffers. 175793746Sjulian */ 175893746Sjulian for (i = 0; i < MY_TX_LIST_CNT; i++) { 175993746Sjulian if (sc->my_cdata.my_tx_chain[i].my_mbuf != NULL) { 176093746Sjulian m_freem(sc->my_cdata.my_tx_chain[i].my_mbuf); 176193746Sjulian sc->my_cdata.my_tx_chain[i].my_mbuf = NULL; 176293746Sjulian } 176393746Sjulian } 176493746Sjulian bzero((char *)&sc->my_ldata->my_tx_list, 176593746Sjulian sizeof(sc->my_ldata->my_tx_list)); 1766148887Srwatson ifp->if_drv_flags &= ~(IFF_DRV_RUNNING | IFF_DRV_OACTIVE); 176793746Sjulian return; 176893746Sjulian} 176993746Sjulian 177093746Sjulian/* 177193746Sjulian * Stop all chip I/O so that the kernel's probe routines don't get confused 177293746Sjulian * by errant DMAs when rebooting. 177393746Sjulian */ 1774188172Simpstatic int 177593746Sjulianmy_shutdown(device_t dev) 177693746Sjulian{ 177793746Sjulian struct my_softc *sc; 177893746Sjulian 177993746Sjulian sc = device_get_softc(dev); 1780149151Sjhb MY_LOCK(sc); 178193746Sjulian my_stop(sc); 1782149151Sjhb MY_UNLOCK(sc); 1783188172Simp return 0; 178493746Sjulian} 1785