if_my.c revision 331643
1119418Sobrien/*- 2330897Seadler * SPDX-License-Identifier: BSD-2-Clause-FreeBSD 3330897Seadler * 4119418Sobrien * Written by: yen_cw@myson.com.tw 593746Sjulian * Copyright (c) 2002 Myson Technology Inc. 693746Sjulian * All rights reserved. 793746Sjulian * 893746Sjulian * Redistribution and use in source and binary forms, with or without 993746Sjulian * modification, are permitted provided that the following conditions 1093746Sjulian * are met: 1193746Sjulian * 1. Redistributions of source code must retain the above copyright 1293746Sjulian * notice, this list of conditions, and the following disclaimer, 1393746Sjulian * without modification, immediately at the beginning of the file. 1493746Sjulian * 2. The name of the author may not be used to endorse or promote products 1593746Sjulian * derived from this software without specific prior written permission. 1693746Sjulian * 1793746Sjulian * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND 1893746Sjulian * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 1993746Sjulian * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 2093746Sjulian * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE FOR 2193746Sjulian * ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 2293746Sjulian * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 2393746Sjulian * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 2493746Sjulian * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 2593746Sjulian * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 2693746Sjulian * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 2793746Sjulian * SUCH DAMAGE. 2893746Sjulian * 29119418Sobrien * Myson fast ethernet PCI NIC driver, available at: http://www.myson.com.tw/ 3093746Sjulian */ 31113038Sobrien 32113038Sobrien#include <sys/cdefs.h> 33113038Sobrien__FBSDID("$FreeBSD: stable/11/sys/dev/my/if_my.c 331643 2018-03-27 18:52:27Z dim $"); 34113038Sobrien 3593746Sjulian#include <sys/param.h> 3693746Sjulian#include <sys/systm.h> 3793746Sjulian#include <sys/sockio.h> 3893746Sjulian#include <sys/mbuf.h> 3993746Sjulian#include <sys/malloc.h> 4093746Sjulian#include <sys/kernel.h> 4193746Sjulian#include <sys/socket.h> 4293746Sjulian#include <sys/queue.h> 4393746Sjulian#include <sys/types.h> 4493746Sjulian#include <sys/module.h> 4595807Sjulian#include <sys/lock.h> 4695807Sjulian#include <sys/mutex.h> 4793746Sjulian 4893746Sjulian#define NBPFILTER 1 4993746Sjulian 5093746Sjulian#include <net/if.h> 51257176Sglebius#include <net/if_var.h> 5293746Sjulian#include <net/if_arp.h> 5393746Sjulian#include <net/ethernet.h> 5493746Sjulian#include <net/if_media.h> 55147256Sbrooks#include <net/if_types.h> 5693746Sjulian#include <net/if_dl.h> 5793746Sjulian#include <net/bpf.h> 5893746Sjulian 5993746Sjulian#include <vm/vm.h> /* for vtophys */ 6093746Sjulian#include <vm/pmap.h> /* for vtophys */ 6193746Sjulian#include <machine/bus.h> 6293746Sjulian#include <machine/resource.h> 6393746Sjulian#include <sys/bus.h> 6493746Sjulian#include <sys/rman.h> 6593746Sjulian 66119285Simp#include <dev/pci/pcireg.h> 67119285Simp#include <dev/pci/pcivar.h> 6893746Sjulian 6993746Sjulian/* 7093746Sjulian * #define MY_USEIOSPACE 7193746Sjulian */ 7293746Sjulian 7393746Sjulianstatic int MY_USEIOSPACE = 1; 7493746Sjulian 75153084Sru#ifdef MY_USEIOSPACE 7694904Sjulian#define MY_RES SYS_RES_IOPORT 7794904Sjulian#define MY_RID MY_PCI_LOIO 7893746Sjulian#else 7994904Sjulian#define MY_RES SYS_RES_MEMORY 8094904Sjulian#define MY_RID MY_PCI_LOMEM 8193746Sjulian#endif 8293746Sjulian 8393746Sjulian 8493746Sjulian#include <dev/my/if_myreg.h> 8593746Sjulian 8693746Sjulian/* 8793746Sjulian * Various supported device vendors/types and their names. 8893746Sjulian */ 8993746Sjulianstruct my_type *my_info_tmp; 9093746Sjulianstatic struct my_type my_devs[] = { 9193746Sjulian {MYSONVENDORID, MTD800ID, "Myson MTD80X Based Fast Ethernet Card"}, 9293746Sjulian {MYSONVENDORID, MTD803ID, "Myson MTD80X Based Fast Ethernet Card"}, 9393746Sjulian {MYSONVENDORID, MTD891ID, "Myson MTD89X Based Giga Ethernet Card"}, 9493746Sjulian {0, 0, NULL} 9593746Sjulian}; 9693746Sjulian 9793746Sjulian/* 9893746Sjulian * Various supported PHY vendors/types and their names. Note that this driver 9993746Sjulian * will work with pretty much any MII-compliant PHY, so failure to positively 10093746Sjulian * identify the chip is not a fatal error. 10193746Sjulian */ 10293746Sjulianstatic struct my_type my_phys[] = { 10393746Sjulian {MysonPHYID0, MysonPHYID0, "<MYSON MTD981>"}, 10493746Sjulian {SeeqPHYID0, SeeqPHYID0, "<SEEQ 80225>"}, 10593746Sjulian {AhdocPHYID0, AhdocPHYID0, "<AHDOC 101>"}, 10693746Sjulian {MarvellPHYID0, MarvellPHYID0, "<MARVELL 88E1000>"}, 10793746Sjulian {LevelOnePHYID0, LevelOnePHYID0, "<LevelOne LXT1000>"}, 10893746Sjulian {0, 0, "<MII-compliant physical interface>"} 10993746Sjulian}; 11093746Sjulian 11193746Sjulianstatic int my_probe(device_t); 11293746Sjulianstatic int my_attach(device_t); 11393746Sjulianstatic int my_detach(device_t); 11493746Sjulianstatic int my_newbuf(struct my_softc *, struct my_chain_onefrag *); 11593746Sjulianstatic int my_encap(struct my_softc *, struct my_chain *, struct mbuf *); 11693746Sjulianstatic void my_rxeof(struct my_softc *); 11793746Sjulianstatic void my_txeof(struct my_softc *); 11893746Sjulianstatic void my_txeoc(struct my_softc *); 11993746Sjulianstatic void my_intr(void *); 12093746Sjulianstatic void my_start(struct ifnet *); 121149151Sjhbstatic void my_start_locked(struct ifnet *); 12293746Sjulianstatic int my_ioctl(struct ifnet *, u_long, caddr_t); 12393746Sjulianstatic void my_init(void *); 124149151Sjhbstatic void my_init_locked(struct my_softc *); 12593746Sjulianstatic void my_stop(struct my_softc *); 126199540Sjhbstatic void my_autoneg_timeout(void *); 127199540Sjhbstatic void my_watchdog(void *); 128188172Simpstatic int my_shutdown(device_t); 12993746Sjulianstatic int my_ifmedia_upd(struct ifnet *); 13093746Sjulianstatic void my_ifmedia_sts(struct ifnet *, struct ifmediareq *); 13193746Sjulianstatic u_int16_t my_phy_readreg(struct my_softc *, int); 13293746Sjulianstatic void my_phy_writereg(struct my_softc *, int, int); 13393746Sjulianstatic void my_autoneg_xmit(struct my_softc *); 13493746Sjulianstatic void my_autoneg_mii(struct my_softc *, int, int); 13593746Sjulianstatic void my_setmode_mii(struct my_softc *, int); 13693746Sjulianstatic void my_getmode_mii(struct my_softc *); 13793746Sjulianstatic void my_setcfg(struct my_softc *, int); 13893746Sjulianstatic void my_setmulti(struct my_softc *); 13993746Sjulianstatic void my_reset(struct my_softc *); 14093746Sjulianstatic int my_list_rx_init(struct my_softc *); 14193746Sjulianstatic int my_list_tx_init(struct my_softc *); 14293746Sjulianstatic long my_send_cmd_to_phy(struct my_softc *, int, int); 14393746Sjulian 144106696Salfred#define MY_SETBIT(sc, reg, x) CSR_WRITE_4(sc, reg, CSR_READ_4(sc, reg) | (x)) 145106696Salfred#define MY_CLRBIT(sc, reg, x) CSR_WRITE_4(sc, reg, CSR_READ_4(sc, reg) & ~(x)) 14693746Sjulian 14793746Sjulianstatic device_method_t my_methods[] = { 14893746Sjulian /* Device interface */ 14993746Sjulian DEVMETHOD(device_probe, my_probe), 15093746Sjulian DEVMETHOD(device_attach, my_attach), 15193746Sjulian DEVMETHOD(device_detach, my_detach), 15293746Sjulian DEVMETHOD(device_shutdown, my_shutdown), 15393746Sjulian 154246128Ssbz DEVMETHOD_END 15593746Sjulian}; 15693746Sjulian 15793746Sjulianstatic driver_t my_driver = { 15893746Sjulian "my", 15993746Sjulian my_methods, 16093746Sjulian sizeof(struct my_softc) 16193746Sjulian}; 16293746Sjulian 16393746Sjulianstatic devclass_t my_devclass; 16493746Sjulian 165113506SmdoddDRIVER_MODULE(my, pci, my_driver, my_devclass, 0, 0); 166113506SmdoddMODULE_DEPEND(my, pci, 1, 1, 1); 167113506SmdoddMODULE_DEPEND(my, ether, 1, 1, 1); 16893746Sjulian 16993746Sjulianstatic long 17093746Sjulianmy_send_cmd_to_phy(struct my_softc * sc, int opcode, int regad) 17193746Sjulian{ 17293746Sjulian long miir; 17393746Sjulian int i; 17493746Sjulian int mask, data; 17593746Sjulian 176149151Sjhb MY_LOCK_ASSERT(sc); 17793746Sjulian 17893746Sjulian /* enable MII output */ 17993746Sjulian miir = CSR_READ_4(sc, MY_MANAGEMENT); 18093746Sjulian miir &= 0xfffffff0; 18193746Sjulian 18293746Sjulian miir |= MY_MASK_MIIR_MII_WRITE + MY_MASK_MIIR_MII_MDO; 18393746Sjulian 18493746Sjulian /* send 32 1's preamble */ 18593746Sjulian for (i = 0; i < 32; i++) { 18693746Sjulian /* low MDC; MDO is already high (miir) */ 18793746Sjulian miir &= ~MY_MASK_MIIR_MII_MDC; 18893746Sjulian CSR_WRITE_4(sc, MY_MANAGEMENT, miir); 18993746Sjulian 19093746Sjulian /* high MDC */ 19193746Sjulian miir |= MY_MASK_MIIR_MII_MDC; 19293746Sjulian CSR_WRITE_4(sc, MY_MANAGEMENT, miir); 19393746Sjulian } 19493746Sjulian 19593746Sjulian /* calculate ST+OP+PHYAD+REGAD+TA */ 19693746Sjulian data = opcode | (sc->my_phy_addr << 7) | (regad << 2); 19793746Sjulian 19893746Sjulian /* sent out */ 19993746Sjulian mask = 0x8000; 20093746Sjulian while (mask) { 20193746Sjulian /* low MDC, prepare MDO */ 20293746Sjulian miir &= ~(MY_MASK_MIIR_MII_MDC + MY_MASK_MIIR_MII_MDO); 20393746Sjulian if (mask & data) 20493746Sjulian miir |= MY_MASK_MIIR_MII_MDO; 20593746Sjulian 20693746Sjulian CSR_WRITE_4(sc, MY_MANAGEMENT, miir); 20793746Sjulian /* high MDC */ 20893746Sjulian miir |= MY_MASK_MIIR_MII_MDC; 20993746Sjulian CSR_WRITE_4(sc, MY_MANAGEMENT, miir); 21093746Sjulian DELAY(30); 21193746Sjulian 21293746Sjulian /* next */ 21393746Sjulian mask >>= 1; 21493746Sjulian if (mask == 0x2 && opcode == MY_OP_READ) 21593746Sjulian miir &= ~MY_MASK_MIIR_MII_WRITE; 21693746Sjulian } 21793746Sjulian 21893746Sjulian return miir; 21993746Sjulian} 22093746Sjulian 22193746Sjulian 222148945Sjhbstatic u_int16_t 22393746Sjulianmy_phy_readreg(struct my_softc * sc, int reg) 22493746Sjulian{ 22593746Sjulian long miir; 22693746Sjulian int mask, data; 22793746Sjulian 228149151Sjhb MY_LOCK_ASSERT(sc); 22993746Sjulian 23093746Sjulian if (sc->my_info->my_did == MTD803ID) 23193746Sjulian data = CSR_READ_2(sc, MY_PHYBASE + reg * 2); 23293746Sjulian else { 23393746Sjulian miir = my_send_cmd_to_phy(sc, MY_OP_READ, reg); 23493746Sjulian 23593746Sjulian /* read data */ 23693746Sjulian mask = 0x8000; 23793746Sjulian data = 0; 23893746Sjulian while (mask) { 23993746Sjulian /* low MDC */ 24093746Sjulian miir &= ~MY_MASK_MIIR_MII_MDC; 24193746Sjulian CSR_WRITE_4(sc, MY_MANAGEMENT, miir); 24293746Sjulian 24393746Sjulian /* read MDI */ 24493746Sjulian miir = CSR_READ_4(sc, MY_MANAGEMENT); 24593746Sjulian if (miir & MY_MASK_MIIR_MII_MDI) 24693746Sjulian data |= mask; 24793746Sjulian 24893746Sjulian /* high MDC, and wait */ 24993746Sjulian miir |= MY_MASK_MIIR_MII_MDC; 25093746Sjulian CSR_WRITE_4(sc, MY_MANAGEMENT, miir); 25193746Sjulian DELAY(30); 25293746Sjulian 25393746Sjulian /* next */ 25493746Sjulian mask >>= 1; 25593746Sjulian } 25693746Sjulian 25793746Sjulian /* low MDC */ 25893746Sjulian miir &= ~MY_MASK_MIIR_MII_MDC; 25993746Sjulian CSR_WRITE_4(sc, MY_MANAGEMENT, miir); 26093746Sjulian } 26193746Sjulian 26293746Sjulian return (u_int16_t) data; 26393746Sjulian} 26493746Sjulian 26593746Sjulian 26693746Sjulianstatic void 26793746Sjulianmy_phy_writereg(struct my_softc * sc, int reg, int data) 26893746Sjulian{ 26993746Sjulian long miir; 27093746Sjulian int mask; 27193746Sjulian 272149151Sjhb MY_LOCK_ASSERT(sc); 27393746Sjulian 27493746Sjulian if (sc->my_info->my_did == MTD803ID) 27593746Sjulian CSR_WRITE_2(sc, MY_PHYBASE + reg * 2, data); 27693746Sjulian else { 27793746Sjulian miir = my_send_cmd_to_phy(sc, MY_OP_WRITE, reg); 27893746Sjulian 27993746Sjulian /* write data */ 28093746Sjulian mask = 0x8000; 28193746Sjulian while (mask) { 28293746Sjulian /* low MDC, prepare MDO */ 28393746Sjulian miir &= ~(MY_MASK_MIIR_MII_MDC + MY_MASK_MIIR_MII_MDO); 28493746Sjulian if (mask & data) 28593746Sjulian miir |= MY_MASK_MIIR_MII_MDO; 28693746Sjulian CSR_WRITE_4(sc, MY_MANAGEMENT, miir); 28793746Sjulian DELAY(1); 28893746Sjulian 28993746Sjulian /* high MDC */ 29093746Sjulian miir |= MY_MASK_MIIR_MII_MDC; 29193746Sjulian CSR_WRITE_4(sc, MY_MANAGEMENT, miir); 29293746Sjulian DELAY(1); 29393746Sjulian 29493746Sjulian /* next */ 29593746Sjulian mask >>= 1; 29693746Sjulian } 29793746Sjulian 29893746Sjulian /* low MDC */ 29993746Sjulian miir &= ~MY_MASK_MIIR_MII_MDC; 30093746Sjulian CSR_WRITE_4(sc, MY_MANAGEMENT, miir); 30193746Sjulian } 30293746Sjulian return; 30393746Sjulian} 30493746Sjulian 30593746Sjulian 30693746Sjulian/* 30793746Sjulian * Program the 64-bit multicast hash filter. 30893746Sjulian */ 30993746Sjulianstatic void 31093746Sjulianmy_setmulti(struct my_softc * sc) 31193746Sjulian{ 31293746Sjulian struct ifnet *ifp; 31393746Sjulian int h = 0; 31493746Sjulian u_int32_t hashes[2] = {0, 0}; 31593746Sjulian struct ifmultiaddr *ifma; 31693746Sjulian u_int32_t rxfilt; 31793746Sjulian int mcnt = 0; 31893746Sjulian 319149151Sjhb MY_LOCK_ASSERT(sc); 32093746Sjulian 321147256Sbrooks ifp = sc->my_ifp; 32293746Sjulian 32393746Sjulian rxfilt = CSR_READ_4(sc, MY_TCRRCR); 32493746Sjulian 32593746Sjulian if (ifp->if_flags & IFF_ALLMULTI || ifp->if_flags & IFF_PROMISC) { 32693746Sjulian rxfilt |= MY_AM; 32793746Sjulian CSR_WRITE_4(sc, MY_TCRRCR, rxfilt); 32893746Sjulian CSR_WRITE_4(sc, MY_MAR0, 0xFFFFFFFF); 32993746Sjulian CSR_WRITE_4(sc, MY_MAR1, 0xFFFFFFFF); 33093746Sjulian 33193746Sjulian return; 33293746Sjulian } 33393746Sjulian /* first, zot all the existing hash bits */ 33493746Sjulian CSR_WRITE_4(sc, MY_MAR0, 0); 33593746Sjulian CSR_WRITE_4(sc, MY_MAR1, 0); 33693746Sjulian 33793746Sjulian /* now program new ones */ 338195049Srwatson if_maddr_rlock(ifp); 33993746Sjulian TAILQ_FOREACH(ifma, &ifp->if_multiaddrs, ifma_link) { 34093746Sjulian if (ifma->ifma_addr->sa_family != AF_LINK) 34193746Sjulian continue; 342130270Snaddy h = ~ether_crc32_be(LLADDR((struct sockaddr_dl *) 343130270Snaddy ifma->ifma_addr), ETHER_ADDR_LEN) >> 26; 34493746Sjulian if (h < 32) 34593746Sjulian hashes[0] |= (1 << h); 34693746Sjulian else 34793746Sjulian hashes[1] |= (1 << (h - 32)); 34893746Sjulian mcnt++; 34993746Sjulian } 350195049Srwatson if_maddr_runlock(ifp); 35193746Sjulian 35293746Sjulian if (mcnt) 35393746Sjulian rxfilt |= MY_AM; 35493746Sjulian else 35593746Sjulian rxfilt &= ~MY_AM; 35693746Sjulian CSR_WRITE_4(sc, MY_MAR0, hashes[0]); 35793746Sjulian CSR_WRITE_4(sc, MY_MAR1, hashes[1]); 35893746Sjulian CSR_WRITE_4(sc, MY_TCRRCR, rxfilt); 35993746Sjulian return; 36093746Sjulian} 36193746Sjulian 36293746Sjulian/* 36393746Sjulian * Initiate an autonegotiation session. 36493746Sjulian */ 36593746Sjulianstatic void 36693746Sjulianmy_autoneg_xmit(struct my_softc * sc) 36793746Sjulian{ 36893746Sjulian u_int16_t phy_sts = 0; 36993746Sjulian 370149151Sjhb MY_LOCK_ASSERT(sc); 37193746Sjulian 37293746Sjulian my_phy_writereg(sc, PHY_BMCR, PHY_BMCR_RESET); 37393746Sjulian DELAY(500); 37493746Sjulian while (my_phy_readreg(sc, PHY_BMCR) & PHY_BMCR_RESET); 37593746Sjulian 37693746Sjulian phy_sts = my_phy_readreg(sc, PHY_BMCR); 37793746Sjulian phy_sts |= PHY_BMCR_AUTONEGENBL | PHY_BMCR_AUTONEGRSTR; 37893746Sjulian my_phy_writereg(sc, PHY_BMCR, phy_sts); 37993746Sjulian 38093746Sjulian return; 38193746Sjulian} 38293746Sjulian 383199540Sjhbstatic void 384199540Sjhbmy_autoneg_timeout(void *arg) 385199540Sjhb{ 386199540Sjhb struct my_softc *sc; 38793746Sjulian 388199540Sjhb sc = arg; 389199540Sjhb MY_LOCK_ASSERT(sc); 390199540Sjhb my_autoneg_mii(sc, MY_FLAG_DELAYTIMEO, 1); 391199540Sjhb} 392199540Sjhb 39393746Sjulian/* 39493746Sjulian * Invoke autonegotiation on a PHY. 39593746Sjulian */ 39693746Sjulianstatic void 39793746Sjulianmy_autoneg_mii(struct my_softc * sc, int flag, int verbose) 39893746Sjulian{ 39993746Sjulian u_int16_t phy_sts = 0, media, advert, ability; 40093746Sjulian u_int16_t ability2 = 0; 40193746Sjulian struct ifnet *ifp; 40293746Sjulian struct ifmedia *ifm; 40393746Sjulian 404149151Sjhb MY_LOCK_ASSERT(sc); 40593746Sjulian 40693746Sjulian ifm = &sc->ifmedia; 407147256Sbrooks ifp = sc->my_ifp; 40893746Sjulian 40993746Sjulian ifm->ifm_media = IFM_ETHER | IFM_AUTO; 41093746Sjulian 41193746Sjulian#ifndef FORCE_AUTONEG_TFOUR 41293746Sjulian /* 41393746Sjulian * First, see if autoneg is supported. If not, there's no point in 41493746Sjulian * continuing. 41593746Sjulian */ 41693746Sjulian phy_sts = my_phy_readreg(sc, PHY_BMSR); 41793746Sjulian if (!(phy_sts & PHY_BMSR_CANAUTONEG)) { 41893746Sjulian if (verbose) 419162321Sglebius device_printf(sc->my_dev, 420162321Sglebius "autonegotiation not supported\n"); 42193746Sjulian ifm->ifm_media = IFM_ETHER | IFM_10_T | IFM_HDX; 42293746Sjulian return; 42393746Sjulian } 42493746Sjulian#endif 42593746Sjulian switch (flag) { 42693746Sjulian case MY_FLAG_FORCEDELAY: 42793746Sjulian /* 42893746Sjulian * XXX Never use this option anywhere but in the probe 42993746Sjulian * routine: making the kernel stop dead in its tracks for 43093746Sjulian * three whole seconds after we've gone multi-user is really 43193746Sjulian * bad manners. 43293746Sjulian */ 43393746Sjulian my_autoneg_xmit(sc); 43493746Sjulian DELAY(5000000); 43593746Sjulian break; 43693746Sjulian case MY_FLAG_SCHEDDELAY: 43793746Sjulian /* 43893746Sjulian * Wait for the transmitter to go idle before starting an 43993746Sjulian * autoneg session, otherwise my_start() may clobber our 44093746Sjulian * timeout, and we don't want to allow transmission during an 44193746Sjulian * autoneg session since that can screw it up. 44293746Sjulian */ 44393746Sjulian if (sc->my_cdata.my_tx_head != NULL) { 44493746Sjulian sc->my_want_auto = 1; 44593746Sjulian MY_UNLOCK(sc); 44693746Sjulian return; 44793746Sjulian } 44893746Sjulian my_autoneg_xmit(sc); 449199540Sjhb callout_reset(&sc->my_autoneg_timer, hz * 5, my_autoneg_timeout, 450199540Sjhb sc); 45193746Sjulian sc->my_autoneg = 1; 45293746Sjulian sc->my_want_auto = 0; 45393746Sjulian return; 45493746Sjulian case MY_FLAG_DELAYTIMEO: 455199540Sjhb callout_stop(&sc->my_autoneg_timer); 45693746Sjulian sc->my_autoneg = 0; 45793746Sjulian break; 45893746Sjulian default: 459162321Sglebius device_printf(sc->my_dev, "invalid autoneg flag: %d\n", flag); 46093746Sjulian return; 46193746Sjulian } 46293746Sjulian 46393746Sjulian if (my_phy_readreg(sc, PHY_BMSR) & PHY_BMSR_AUTONEGCOMP) { 46493746Sjulian if (verbose) 465162321Sglebius device_printf(sc->my_dev, "autoneg complete, "); 46693746Sjulian phy_sts = my_phy_readreg(sc, PHY_BMSR); 46793746Sjulian } else { 46893746Sjulian if (verbose) 469162321Sglebius device_printf(sc->my_dev, "autoneg not complete, "); 47093746Sjulian } 47193746Sjulian 47293746Sjulian media = my_phy_readreg(sc, PHY_BMCR); 47393746Sjulian 47493746Sjulian /* Link is good. Report modes and set duplex mode. */ 47593746Sjulian if (my_phy_readreg(sc, PHY_BMSR) & PHY_BMSR_LINKSTAT) { 47693746Sjulian if (verbose) 477162321Sglebius device_printf(sc->my_dev, "link status good. "); 47893746Sjulian advert = my_phy_readreg(sc, PHY_ANAR); 47993746Sjulian ability = my_phy_readreg(sc, PHY_LPAR); 48093746Sjulian if ((sc->my_pinfo->my_vid == MarvellPHYID0) || 48193746Sjulian (sc->my_pinfo->my_vid == LevelOnePHYID0)) { 48293746Sjulian ability2 = my_phy_readreg(sc, PHY_1000SR); 48393746Sjulian if (ability2 & PHY_1000SR_1000BTXFULL) { 48493746Sjulian advert = 0; 48593746Sjulian ability = 0; 48693746Sjulian /* 48793746Sjulian * this version did not support 1000M, 48893746Sjulian * ifm->ifm_media = 48995673Sphk * IFM_ETHER|IFM_1000_T|IFM_FDX; 49093746Sjulian */ 49193746Sjulian ifm->ifm_media = 49293746Sjulian IFM_ETHER | IFM_100_TX | IFM_FDX; 49393746Sjulian media &= ~PHY_BMCR_SPEEDSEL; 49493746Sjulian media |= PHY_BMCR_1000; 49593746Sjulian media |= PHY_BMCR_DUPLEX; 49693746Sjulian printf("(full-duplex, 1000Mbps)\n"); 49793746Sjulian } else if (ability2 & PHY_1000SR_1000BTXHALF) { 49893746Sjulian advert = 0; 49993746Sjulian ability = 0; 50093746Sjulian /* 50193746Sjulian * this version did not support 1000M, 50295673Sphk * ifm->ifm_media = IFM_ETHER|IFM_1000_T; 50393746Sjulian */ 50493746Sjulian ifm->ifm_media = IFM_ETHER | IFM_100_TX; 50593746Sjulian media &= ~PHY_BMCR_SPEEDSEL; 50693746Sjulian media &= ~PHY_BMCR_DUPLEX; 50793746Sjulian media |= PHY_BMCR_1000; 50893746Sjulian printf("(half-duplex, 1000Mbps)\n"); 50993746Sjulian } 51093746Sjulian } 51193746Sjulian if (advert & PHY_ANAR_100BT4 && ability & PHY_ANAR_100BT4) { 51293746Sjulian ifm->ifm_media = IFM_ETHER | IFM_100_T4; 51393746Sjulian media |= PHY_BMCR_SPEEDSEL; 51493746Sjulian media &= ~PHY_BMCR_DUPLEX; 51593746Sjulian printf("(100baseT4)\n"); 51693746Sjulian } else if (advert & PHY_ANAR_100BTXFULL && 51793746Sjulian ability & PHY_ANAR_100BTXFULL) { 51893746Sjulian ifm->ifm_media = IFM_ETHER | IFM_100_TX | IFM_FDX; 51993746Sjulian media |= PHY_BMCR_SPEEDSEL; 52093746Sjulian media |= PHY_BMCR_DUPLEX; 52193746Sjulian printf("(full-duplex, 100Mbps)\n"); 52293746Sjulian } else if (advert & PHY_ANAR_100BTXHALF && 52393746Sjulian ability & PHY_ANAR_100BTXHALF) { 52493746Sjulian ifm->ifm_media = IFM_ETHER | IFM_100_TX | IFM_HDX; 52593746Sjulian media |= PHY_BMCR_SPEEDSEL; 52693746Sjulian media &= ~PHY_BMCR_DUPLEX; 52793746Sjulian printf("(half-duplex, 100Mbps)\n"); 52893746Sjulian } else if (advert & PHY_ANAR_10BTFULL && 52993746Sjulian ability & PHY_ANAR_10BTFULL) { 53093746Sjulian ifm->ifm_media = IFM_ETHER | IFM_10_T | IFM_FDX; 53193746Sjulian media &= ~PHY_BMCR_SPEEDSEL; 53293746Sjulian media |= PHY_BMCR_DUPLEX; 53393746Sjulian printf("(full-duplex, 10Mbps)\n"); 53493746Sjulian } else if (advert) { 53593746Sjulian ifm->ifm_media = IFM_ETHER | IFM_10_T | IFM_HDX; 53693746Sjulian media &= ~PHY_BMCR_SPEEDSEL; 53793746Sjulian media &= ~PHY_BMCR_DUPLEX; 53893746Sjulian printf("(half-duplex, 10Mbps)\n"); 53993746Sjulian } 54093746Sjulian media &= ~PHY_BMCR_AUTONEGENBL; 54193746Sjulian 54293746Sjulian /* Set ASIC's duplex mode to match the PHY. */ 54393746Sjulian my_phy_writereg(sc, PHY_BMCR, media); 54493746Sjulian my_setcfg(sc, media); 54593746Sjulian } else { 54693746Sjulian if (verbose) 547162321Sglebius device_printf(sc->my_dev, "no carrier\n"); 54893746Sjulian } 54993746Sjulian 550149151Sjhb my_init_locked(sc); 55193746Sjulian if (sc->my_tx_pend) { 55293746Sjulian sc->my_autoneg = 0; 55393746Sjulian sc->my_tx_pend = 0; 554149151Sjhb my_start_locked(ifp); 55593746Sjulian } 55693746Sjulian return; 55793746Sjulian} 55893746Sjulian 55993746Sjulian/* 56093746Sjulian * To get PHY ability. 56193746Sjulian */ 56293746Sjulianstatic void 56393746Sjulianmy_getmode_mii(struct my_softc * sc) 56493746Sjulian{ 56593746Sjulian u_int16_t bmsr; 56693746Sjulian struct ifnet *ifp; 56793746Sjulian 568149151Sjhb MY_LOCK_ASSERT(sc); 569147256Sbrooks ifp = sc->my_ifp; 57093746Sjulian bmsr = my_phy_readreg(sc, PHY_BMSR); 57193746Sjulian if (bootverbose) 572162321Sglebius device_printf(sc->my_dev, "PHY status word: %x\n", bmsr); 57393746Sjulian 57493746Sjulian /* fallback */ 57593746Sjulian sc->ifmedia.ifm_media = IFM_ETHER | IFM_10_T | IFM_HDX; 57693746Sjulian 57793746Sjulian if (bmsr & PHY_BMSR_10BTHALF) { 57893746Sjulian if (bootverbose) 579162321Sglebius device_printf(sc->my_dev, 580162321Sglebius "10Mbps half-duplex mode supported\n"); 58193746Sjulian ifmedia_add(&sc->ifmedia, IFM_ETHER | IFM_10_T | IFM_HDX, 58293746Sjulian 0, NULL); 58393746Sjulian ifmedia_add(&sc->ifmedia, IFM_ETHER | IFM_10_T, 0, NULL); 58493746Sjulian } 58593746Sjulian if (bmsr & PHY_BMSR_10BTFULL) { 58693746Sjulian if (bootverbose) 587162321Sglebius device_printf(sc->my_dev, 588162321Sglebius "10Mbps full-duplex mode supported\n"); 58993746Sjulian 59093746Sjulian ifmedia_add(&sc->ifmedia, IFM_ETHER | IFM_10_T | IFM_FDX, 59193746Sjulian 0, NULL); 59293746Sjulian sc->ifmedia.ifm_media = IFM_ETHER | IFM_10_T | IFM_FDX; 59393746Sjulian } 59493746Sjulian if (bmsr & PHY_BMSR_100BTXHALF) { 59593746Sjulian if (bootverbose) 596162321Sglebius device_printf(sc->my_dev, 597162321Sglebius "100Mbps half-duplex mode supported\n"); 59893746Sjulian ifp->if_baudrate = 100000000; 59993746Sjulian ifmedia_add(&sc->ifmedia, IFM_ETHER | IFM_100_TX, 0, NULL); 60093746Sjulian ifmedia_add(&sc->ifmedia, IFM_ETHER | IFM_100_TX | IFM_HDX, 60193746Sjulian 0, NULL); 60293746Sjulian sc->ifmedia.ifm_media = IFM_ETHER | IFM_100_TX | IFM_HDX; 60393746Sjulian } 60493746Sjulian if (bmsr & PHY_BMSR_100BTXFULL) { 60593746Sjulian if (bootverbose) 606162321Sglebius device_printf(sc->my_dev, 607162321Sglebius "100Mbps full-duplex mode supported\n"); 60893746Sjulian ifp->if_baudrate = 100000000; 60993746Sjulian ifmedia_add(&sc->ifmedia, IFM_ETHER | IFM_100_TX | IFM_FDX, 61093746Sjulian 0, NULL); 61193746Sjulian sc->ifmedia.ifm_media = IFM_ETHER | IFM_100_TX | IFM_FDX; 61293746Sjulian } 61393746Sjulian /* Some also support 100BaseT4. */ 61493746Sjulian if (bmsr & PHY_BMSR_100BT4) { 61593746Sjulian if (bootverbose) 616162321Sglebius device_printf(sc->my_dev, "100baseT4 mode supported\n"); 61793746Sjulian ifp->if_baudrate = 100000000; 61893746Sjulian ifmedia_add(&sc->ifmedia, IFM_ETHER | IFM_100_T4, 0, NULL); 61993746Sjulian sc->ifmedia.ifm_media = IFM_ETHER | IFM_100_T4; 62093746Sjulian#ifdef FORCE_AUTONEG_TFOUR 62193746Sjulian if (bootverbose) 622162321Sglebius device_printf(sc->my_dev, 623162321Sglebius "forcing on autoneg support for BT4\n"); 62493746Sjulian ifmedia_add(&sc->ifmedia, IFM_ETHER | IFM_AUTO, 0 NULL): 62593746Sjulian sc->ifmedia.ifm_media = IFM_ETHER | IFM_AUTO; 62693746Sjulian#endif 62793746Sjulian } 62894863Sjulian#if 0 /* this version did not support 1000M, */ 62993746Sjulian if (sc->my_pinfo->my_vid == MarvellPHYID0) { 63093746Sjulian if (bootverbose) 631162321Sglebius device_printf(sc->my_dev, 632162321Sglebius "1000Mbps half-duplex mode supported\n"); 63393746Sjulian 63493746Sjulian ifp->if_baudrate = 1000000000; 63595673Sphk ifmedia_add(&sc->ifmedia, IFM_ETHER | IFM_1000_T, 0, NULL); 63695673Sphk ifmedia_add(&sc->ifmedia, IFM_ETHER | IFM_1000_T | IFM_HDX, 63793746Sjulian 0, NULL); 63893746Sjulian if (bootverbose) 639162321Sglebius device_printf(sc->my_dev, 640162321Sglebius "1000Mbps full-duplex mode supported\n"); 64193746Sjulian ifp->if_baudrate = 1000000000; 64295673Sphk ifmedia_add(&sc->ifmedia, IFM_ETHER | IFM_1000_T | IFM_FDX, 64393746Sjulian 0, NULL); 64495673Sphk sc->ifmedia.ifm_media = IFM_ETHER | IFM_1000_T | IFM_FDX; 64593746Sjulian } 64693746Sjulian#endif 64793746Sjulian if (bmsr & PHY_BMSR_CANAUTONEG) { 64893746Sjulian if (bootverbose) 649162321Sglebius device_printf(sc->my_dev, "autoneg supported\n"); 65093746Sjulian ifmedia_add(&sc->ifmedia, IFM_ETHER | IFM_AUTO, 0, NULL); 65193746Sjulian sc->ifmedia.ifm_media = IFM_ETHER | IFM_AUTO; 65293746Sjulian } 65393746Sjulian return; 65493746Sjulian} 65593746Sjulian 65693746Sjulian/* 65793746Sjulian * Set speed and duplex mode. 65893746Sjulian */ 65993746Sjulianstatic void 66093746Sjulianmy_setmode_mii(struct my_softc * sc, int media) 66193746Sjulian{ 66293746Sjulian u_int16_t bmcr; 66393746Sjulian 664149151Sjhb MY_LOCK_ASSERT(sc); 66593746Sjulian /* 66693746Sjulian * If an autoneg session is in progress, stop it. 66793746Sjulian */ 66893746Sjulian if (sc->my_autoneg) { 669162321Sglebius device_printf(sc->my_dev, "canceling autoneg session\n"); 670199540Sjhb callout_stop(&sc->my_autoneg_timer); 671199540Sjhb sc->my_autoneg = sc->my_want_auto = 0; 67293746Sjulian bmcr = my_phy_readreg(sc, PHY_BMCR); 67393746Sjulian bmcr &= ~PHY_BMCR_AUTONEGENBL; 67493746Sjulian my_phy_writereg(sc, PHY_BMCR, bmcr); 67593746Sjulian } 676162321Sglebius device_printf(sc->my_dev, "selecting MII, "); 67793746Sjulian bmcr = my_phy_readreg(sc, PHY_BMCR); 67893746Sjulian bmcr &= ~(PHY_BMCR_AUTONEGENBL | PHY_BMCR_SPEEDSEL | PHY_BMCR_1000 | 67993746Sjulian PHY_BMCR_DUPLEX | PHY_BMCR_LOOPBK); 68094863Sjulian 68194863Sjulian#if 0 /* this version did not support 1000M, */ 68295673Sphk if (IFM_SUBTYPE(media) == IFM_1000_T) { 68393746Sjulian printf("1000Mbps/T4, half-duplex\n"); 68493746Sjulian bmcr &= ~PHY_BMCR_SPEEDSEL; 68593746Sjulian bmcr &= ~PHY_BMCR_DUPLEX; 68693746Sjulian bmcr |= PHY_BMCR_1000; 68793746Sjulian } 68893746Sjulian#endif 68993746Sjulian if (IFM_SUBTYPE(media) == IFM_100_T4) { 69093746Sjulian printf("100Mbps/T4, half-duplex\n"); 69193746Sjulian bmcr |= PHY_BMCR_SPEEDSEL; 69293746Sjulian bmcr &= ~PHY_BMCR_DUPLEX; 69393746Sjulian } 69493746Sjulian if (IFM_SUBTYPE(media) == IFM_100_TX) { 69593746Sjulian printf("100Mbps, "); 69693746Sjulian bmcr |= PHY_BMCR_SPEEDSEL; 69793746Sjulian } 69893746Sjulian if (IFM_SUBTYPE(media) == IFM_10_T) { 69993746Sjulian printf("10Mbps, "); 70093746Sjulian bmcr &= ~PHY_BMCR_SPEEDSEL; 70193746Sjulian } 70293746Sjulian if ((media & IFM_GMASK) == IFM_FDX) { 70393746Sjulian printf("full duplex\n"); 70493746Sjulian bmcr |= PHY_BMCR_DUPLEX; 70593746Sjulian } else { 70693746Sjulian printf("half duplex\n"); 70793746Sjulian bmcr &= ~PHY_BMCR_DUPLEX; 70893746Sjulian } 70993746Sjulian my_phy_writereg(sc, PHY_BMCR, bmcr); 71093746Sjulian my_setcfg(sc, bmcr); 71193746Sjulian return; 71293746Sjulian} 71393746Sjulian 71493746Sjulian/* 71593746Sjulian * The Myson manual states that in order to fiddle with the 'full-duplex' and 71693746Sjulian * '100Mbps' bits in the netconfig register, we first have to put the 71793746Sjulian * transmit and/or receive logic in the idle state. 71893746Sjulian */ 71993746Sjulianstatic void 72093746Sjulianmy_setcfg(struct my_softc * sc, int bmcr) 72193746Sjulian{ 72293746Sjulian int i, restart = 0; 72393746Sjulian 724149151Sjhb MY_LOCK_ASSERT(sc); 72593746Sjulian if (CSR_READ_4(sc, MY_TCRRCR) & (MY_TE | MY_RE)) { 72693746Sjulian restart = 1; 72793746Sjulian MY_CLRBIT(sc, MY_TCRRCR, (MY_TE | MY_RE)); 72893746Sjulian for (i = 0; i < MY_TIMEOUT; i++) { 72993746Sjulian DELAY(10); 73093746Sjulian if (!(CSR_READ_4(sc, MY_TCRRCR) & 73193746Sjulian (MY_TXRUN | MY_RXRUN))) 73293746Sjulian break; 73393746Sjulian } 73493746Sjulian if (i == MY_TIMEOUT) 735162321Sglebius device_printf(sc->my_dev, 736148945Sjhb "failed to force tx and rx to idle \n"); 73793746Sjulian } 73893746Sjulian MY_CLRBIT(sc, MY_TCRRCR, MY_PS1000); 73993746Sjulian MY_CLRBIT(sc, MY_TCRRCR, MY_PS10); 74093746Sjulian if (bmcr & PHY_BMCR_1000) 74193746Sjulian MY_SETBIT(sc, MY_TCRRCR, MY_PS1000); 74293746Sjulian else if (!(bmcr & PHY_BMCR_SPEEDSEL)) 74393746Sjulian MY_SETBIT(sc, MY_TCRRCR, MY_PS10); 74493746Sjulian if (bmcr & PHY_BMCR_DUPLEX) 74593746Sjulian MY_SETBIT(sc, MY_TCRRCR, MY_FD); 74693746Sjulian else 74793746Sjulian MY_CLRBIT(sc, MY_TCRRCR, MY_FD); 74893746Sjulian if (restart) 74993746Sjulian MY_SETBIT(sc, MY_TCRRCR, MY_TE | MY_RE); 75093746Sjulian return; 75193746Sjulian} 75293746Sjulian 75393746Sjulianstatic void 75493746Sjulianmy_reset(struct my_softc * sc) 75593746Sjulian{ 756331643Sdim int i; 75793746Sjulian 758149151Sjhb MY_LOCK_ASSERT(sc); 75993746Sjulian MY_SETBIT(sc, MY_BCR, MY_SWR); 76093746Sjulian for (i = 0; i < MY_TIMEOUT; i++) { 76193746Sjulian DELAY(10); 76293746Sjulian if (!(CSR_READ_4(sc, MY_BCR) & MY_SWR)) 76393746Sjulian break; 76493746Sjulian } 76593746Sjulian if (i == MY_TIMEOUT) 766162321Sglebius device_printf(sc->my_dev, "reset never completed!\n"); 76793746Sjulian 76893746Sjulian /* Wait a little while for the chip to get its brains in order. */ 76993746Sjulian DELAY(1000); 77093746Sjulian return; 77193746Sjulian} 77293746Sjulian 77393746Sjulian/* 77493746Sjulian * Probe for a Myson chip. Check the PCI vendor and device IDs against our 77593746Sjulian * list and return a device name if we find a match. 77693746Sjulian */ 77793746Sjulianstatic int 77893746Sjulianmy_probe(device_t dev) 77993746Sjulian{ 78093746Sjulian struct my_type *t; 78193746Sjulian 78293746Sjulian t = my_devs; 78393746Sjulian while (t->my_name != NULL) { 78493746Sjulian if ((pci_get_vendor(dev) == t->my_vid) && 78593746Sjulian (pci_get_device(dev) == t->my_did)) { 78693746Sjulian device_set_desc(dev, t->my_name); 78793746Sjulian my_info_tmp = t; 788143158Simp return (BUS_PROBE_DEFAULT); 78993746Sjulian } 79093746Sjulian t++; 79193746Sjulian } 79293746Sjulian return (ENXIO); 79393746Sjulian} 79493746Sjulian 79593746Sjulian/* 79693746Sjulian * Attach the interface. Allocate softc structures, do ifmedia setup and 79793746Sjulian * ethernet/BPF attach. 79893746Sjulian */ 79993746Sjulianstatic int 80093746Sjulianmy_attach(device_t dev) 80193746Sjulian{ 802149151Sjhb int i; 80393746Sjulian u_char eaddr[ETHER_ADDR_LEN]; 804148946Sjhb u_int32_t iobase; 80593746Sjulian struct my_softc *sc; 80693746Sjulian struct ifnet *ifp; 80793746Sjulian int media = IFM_ETHER | IFM_100_TX | IFM_FDX; 80893746Sjulian unsigned int round; 80993746Sjulian caddr_t roundptr; 81093746Sjulian struct my_type *p; 81193746Sjulian u_int16_t phy_vid, phy_did, phy_sts = 0; 812148945Sjhb int rid, error = 0; 81393746Sjulian 81493746Sjulian sc = device_get_softc(dev); 815162321Sglebius sc->my_dev = dev; 81695803Sjulian mtx_init(&sc->my_mtx, device_get_nameunit(dev), MTX_NETWORK_LOCK, 817149151Sjhb MTX_DEF); 818199540Sjhb callout_init_mtx(&sc->my_autoneg_timer, &sc->my_mtx, 0); 819199540Sjhb callout_init_mtx(&sc->my_watchdog, &sc->my_mtx, 0); 82093746Sjulian 82193746Sjulian /* 82293746Sjulian * Map control/status registers. 82393746Sjulian */ 824148946Sjhb pci_enable_busmaster(dev); 82593746Sjulian 82693746Sjulian if (my_info_tmp->my_did == MTD800ID) { 82793746Sjulian iobase = pci_read_config(dev, MY_PCI_LOIO, 4); 82893746Sjulian if (iobase & 0x300) 82993746Sjulian MY_USEIOSPACE = 0; 83093746Sjulian } 83193746Sjulian 83293746Sjulian rid = MY_RID; 833127135Snjl sc->my_res = bus_alloc_resource_any(dev, MY_RES, &rid, RF_ACTIVE); 83493746Sjulian 83593746Sjulian if (sc->my_res == NULL) { 836148945Sjhb device_printf(dev, "couldn't map ports/memory\n"); 83793746Sjulian error = ENXIO; 838149151Sjhb goto destroy_mutex; 83993746Sjulian } 84093746Sjulian sc->my_btag = rman_get_bustag(sc->my_res); 84193746Sjulian sc->my_bhandle = rman_get_bushandle(sc->my_res); 84293746Sjulian 84393746Sjulian rid = 0; 844127135Snjl sc->my_irq = bus_alloc_resource_any(dev, SYS_RES_IRQ, &rid, 845127135Snjl RF_SHAREABLE | RF_ACTIVE); 84693746Sjulian 84793746Sjulian if (sc->my_irq == NULL) { 848148945Sjhb device_printf(dev, "couldn't map interrupt\n"); 84993746Sjulian error = ENXIO; 850149151Sjhb goto release_io; 85193746Sjulian } 85293746Sjulian 85393746Sjulian sc->my_info = my_info_tmp; 85493746Sjulian 85593746Sjulian /* Reset the adapter. */ 856149151Sjhb MY_LOCK(sc); 85793746Sjulian my_reset(sc); 858149151Sjhb MY_UNLOCK(sc); 85993746Sjulian 86093746Sjulian /* 86193746Sjulian * Get station address 86293746Sjulian */ 86393746Sjulian for (i = 0; i < ETHER_ADDR_LEN; ++i) 86493746Sjulian eaddr[i] = CSR_READ_1(sc, MY_PAR0 + i); 86593746Sjulian 86693746Sjulian sc->my_ldata_ptr = malloc(sizeof(struct my_list_data) + 8, 86793746Sjulian M_DEVBUF, M_NOWAIT); 86893746Sjulian if (sc->my_ldata_ptr == NULL) { 869148945Sjhb device_printf(dev, "no memory for list buffers!\n"); 87093746Sjulian error = ENXIO; 871149151Sjhb goto release_irq; 87293746Sjulian } 87393746Sjulian sc->my_ldata = (struct my_list_data *) sc->my_ldata_ptr; 874106588Sjhb round = (uintptr_t)sc->my_ldata_ptr & 0xF; 87593746Sjulian roundptr = sc->my_ldata_ptr; 87693746Sjulian for (i = 0; i < 8; i++) { 87793746Sjulian if (round % 8) { 87893746Sjulian round++; 87993746Sjulian roundptr++; 88093746Sjulian } else 88193746Sjulian break; 88293746Sjulian } 88393746Sjulian sc->my_ldata = (struct my_list_data *) roundptr; 88493746Sjulian bzero(sc->my_ldata, sizeof(struct my_list_data)); 88593746Sjulian 886147256Sbrooks ifp = sc->my_ifp = if_alloc(IFT_ETHER); 887147256Sbrooks if (ifp == NULL) { 888147256Sbrooks device_printf(dev, "can not if_alloc()\n"); 889147256Sbrooks error = ENOSPC; 890149151Sjhb goto free_ldata; 891147256Sbrooks } 89293746Sjulian ifp->if_softc = sc; 893121816Sbrooks if_initname(ifp, device_get_name(dev), device_get_unit(dev)); 89493746Sjulian ifp->if_flags = IFF_BROADCAST | IFF_SIMPLEX | IFF_MULTICAST; 89593746Sjulian ifp->if_ioctl = my_ioctl; 89693746Sjulian ifp->if_start = my_start; 89793746Sjulian ifp->if_init = my_init; 89893746Sjulian ifp->if_baudrate = 10000000; 899207554Ssobomax IFQ_SET_MAXLEN(&ifp->if_snd, ifqmaxlen); 900207554Ssobomax ifp->if_snd.ifq_drv_maxlen = ifqmaxlen; 901159291Sbrueffer IFQ_SET_READY(&ifp->if_snd); 90293746Sjulian 90393746Sjulian if (sc->my_info->my_did == MTD803ID) 90493746Sjulian sc->my_pinfo = my_phys; 90593746Sjulian else { 90693746Sjulian if (bootverbose) 907148945Sjhb device_printf(dev, "probing for a PHY\n"); 908149151Sjhb MY_LOCK(sc); 90993746Sjulian for (i = MY_PHYADDR_MIN; i < MY_PHYADDR_MAX + 1; i++) { 91093746Sjulian if (bootverbose) 911148945Sjhb device_printf(dev, "checking address: %d\n", i); 91293746Sjulian sc->my_phy_addr = i; 91393746Sjulian phy_sts = my_phy_readreg(sc, PHY_BMSR); 91493746Sjulian if ((phy_sts != 0) && (phy_sts != 0xffff)) 91593746Sjulian break; 91693746Sjulian else 91793746Sjulian phy_sts = 0; 91893746Sjulian } 91993746Sjulian if (phy_sts) { 92093746Sjulian phy_vid = my_phy_readreg(sc, PHY_VENID); 92193746Sjulian phy_did = my_phy_readreg(sc, PHY_DEVID); 92293746Sjulian if (bootverbose) { 923148945Sjhb device_printf(dev, "found PHY at address %d, ", 924148945Sjhb sc->my_phy_addr); 92593746Sjulian printf("vendor id: %x device id: %x\n", 92693746Sjulian phy_vid, phy_did); 92793746Sjulian } 92893746Sjulian p = my_phys; 92993746Sjulian while (p->my_vid) { 93093746Sjulian if (phy_vid == p->my_vid) { 93193746Sjulian sc->my_pinfo = p; 93293746Sjulian break; 93393746Sjulian } 93493746Sjulian p++; 93593746Sjulian } 93693746Sjulian if (sc->my_pinfo == NULL) 93793746Sjulian sc->my_pinfo = &my_phys[PHY_UNKNOWN]; 93893746Sjulian if (bootverbose) 939148945Sjhb device_printf(dev, "PHY type: %s\n", 940148945Sjhb sc->my_pinfo->my_name); 94193746Sjulian } else { 942149151Sjhb MY_UNLOCK(sc); 943148945Sjhb device_printf(dev, "MII without any phy!\n"); 94493746Sjulian error = ENXIO; 945149151Sjhb goto free_if; 94693746Sjulian } 947149151Sjhb MY_UNLOCK(sc); 94893746Sjulian } 94993746Sjulian 95093746Sjulian /* Do ifmedia setup. */ 95193746Sjulian ifmedia_init(&sc->ifmedia, 0, my_ifmedia_upd, my_ifmedia_sts); 952149151Sjhb MY_LOCK(sc); 95393746Sjulian my_getmode_mii(sc); 95493746Sjulian my_autoneg_mii(sc, MY_FLAG_FORCEDELAY, 1); 95593746Sjulian media = sc->ifmedia.ifm_media; 95693746Sjulian my_stop(sc); 957149151Sjhb MY_UNLOCK(sc); 95893746Sjulian ifmedia_set(&sc->ifmedia, media); 95993746Sjulian 960106937Ssam ether_ifattach(ifp, eaddr); 961149151Sjhb 962149151Sjhb error = bus_setup_intr(dev, sc->my_irq, INTR_TYPE_NET | INTR_MPSAFE, 963166901Spiso NULL, my_intr, sc, &sc->my_intrhand); 964149151Sjhb 965149151Sjhb if (error) { 966149151Sjhb device_printf(dev, "couldn't set up irq\n"); 967149151Sjhb goto detach_if; 968149151Sjhb } 96993746Sjulian 97093746Sjulian return (0); 97193746Sjulian 972149151Sjhbdetach_if: 973149151Sjhb ether_ifdetach(ifp); 974149151Sjhbfree_if: 975149151Sjhb if_free(ifp); 976149151Sjhbfree_ldata: 977149151Sjhb free(sc->my_ldata_ptr, M_DEVBUF); 978149151Sjhbrelease_irq: 979149151Sjhb bus_release_resource(dev, SYS_RES_IRQ, 0, sc->my_irq); 980149151Sjhbrelease_io: 981149151Sjhb bus_release_resource(dev, MY_RES, MY_RID, sc->my_res); 982149151Sjhbdestroy_mutex: 98393746Sjulian mtx_destroy(&sc->my_mtx); 98493746Sjulian return (error); 98593746Sjulian} 98693746Sjulian 98793746Sjulianstatic int 98893746Sjulianmy_detach(device_t dev) 98993746Sjulian{ 99093746Sjulian struct my_softc *sc; 99193746Sjulian struct ifnet *ifp; 99293746Sjulian 99393746Sjulian sc = device_get_softc(dev); 994199540Sjhb ifp = sc->my_ifp; 995199540Sjhb ether_ifdetach(ifp); 99693746Sjulian MY_LOCK(sc); 997149151Sjhb my_stop(sc); 998149151Sjhb MY_UNLOCK(sc); 999149151Sjhb bus_teardown_intr(dev, sc->my_irq, sc->my_intrhand); 1000199540Sjhb callout_drain(&sc->my_watchdog); 1001199540Sjhb callout_drain(&sc->my_autoneg_timer); 1002149151Sjhb 1003147256Sbrooks if_free(ifp); 1004149151Sjhb free(sc->my_ldata_ptr, M_DEVBUF); 100593746Sjulian 100693746Sjulian bus_release_resource(dev, SYS_RES_IRQ, 0, sc->my_irq); 100793746Sjulian bus_release_resource(dev, MY_RES, MY_RID, sc->my_res); 100893746Sjulian mtx_destroy(&sc->my_mtx); 100993746Sjulian return (0); 101093746Sjulian} 101193746Sjulian 101293746Sjulian 101393746Sjulian/* 101493746Sjulian * Initialize the transmit descriptors. 101593746Sjulian */ 101693746Sjulianstatic int 101793746Sjulianmy_list_tx_init(struct my_softc * sc) 101893746Sjulian{ 101993746Sjulian struct my_chain_data *cd; 102093746Sjulian struct my_list_data *ld; 102193746Sjulian int i; 102293746Sjulian 1023149151Sjhb MY_LOCK_ASSERT(sc); 102493746Sjulian cd = &sc->my_cdata; 102593746Sjulian ld = sc->my_ldata; 102693746Sjulian for (i = 0; i < MY_TX_LIST_CNT; i++) { 102793746Sjulian cd->my_tx_chain[i].my_ptr = &ld->my_tx_list[i]; 102893746Sjulian if (i == (MY_TX_LIST_CNT - 1)) 102993746Sjulian cd->my_tx_chain[i].my_nextdesc = &cd->my_tx_chain[0]; 103093746Sjulian else 103193746Sjulian cd->my_tx_chain[i].my_nextdesc = 103293746Sjulian &cd->my_tx_chain[i + 1]; 103393746Sjulian } 103493746Sjulian cd->my_tx_free = &cd->my_tx_chain[0]; 103593746Sjulian cd->my_tx_tail = cd->my_tx_head = NULL; 103693746Sjulian return (0); 103793746Sjulian} 103893746Sjulian 103993746Sjulian/* 104093746Sjulian * Initialize the RX descriptors and allocate mbufs for them. Note that we 104193746Sjulian * arrange the descriptors in a closed ring, so that the last descriptor 104293746Sjulian * points back to the first. 104393746Sjulian */ 104493746Sjulianstatic int 104593746Sjulianmy_list_rx_init(struct my_softc * sc) 104693746Sjulian{ 104793746Sjulian struct my_chain_data *cd; 104893746Sjulian struct my_list_data *ld; 104993746Sjulian int i; 105093746Sjulian 1051149151Sjhb MY_LOCK_ASSERT(sc); 105293746Sjulian cd = &sc->my_cdata; 105393746Sjulian ld = sc->my_ldata; 105493746Sjulian for (i = 0; i < MY_RX_LIST_CNT; i++) { 105593746Sjulian cd->my_rx_chain[i].my_ptr = 105693746Sjulian (struct my_desc *) & ld->my_rx_list[i]; 105797641Sjulian if (my_newbuf(sc, &cd->my_rx_chain[i]) == ENOBUFS) { 105897641Sjulian MY_UNLOCK(sc); 105993746Sjulian return (ENOBUFS); 106097641Sjulian } 106193746Sjulian if (i == (MY_RX_LIST_CNT - 1)) { 106293746Sjulian cd->my_rx_chain[i].my_nextdesc = &cd->my_rx_chain[0]; 106393746Sjulian ld->my_rx_list[i].my_next = vtophys(&ld->my_rx_list[0]); 106493746Sjulian } else { 106593746Sjulian cd->my_rx_chain[i].my_nextdesc = 106693746Sjulian &cd->my_rx_chain[i + 1]; 106793746Sjulian ld->my_rx_list[i].my_next = 106893746Sjulian vtophys(&ld->my_rx_list[i + 1]); 106993746Sjulian } 107093746Sjulian } 107193746Sjulian cd->my_rx_head = &cd->my_rx_chain[0]; 107293746Sjulian return (0); 107393746Sjulian} 107493746Sjulian 107593746Sjulian/* 107693746Sjulian * Initialize an RX descriptor and attach an MBUF cluster. 107793746Sjulian */ 107893746Sjulianstatic int 107993746Sjulianmy_newbuf(struct my_softc * sc, struct my_chain_onefrag * c) 108093746Sjulian{ 108193746Sjulian struct mbuf *m_new = NULL; 108293746Sjulian 1083149151Sjhb MY_LOCK_ASSERT(sc); 1084243857Sglebius MGETHDR(m_new, M_NOWAIT, MT_DATA); 108593746Sjulian if (m_new == NULL) { 1086162321Sglebius device_printf(sc->my_dev, 1087148945Sjhb "no memory for rx list -- packet dropped!\n"); 108893746Sjulian return (ENOBUFS); 108993746Sjulian } 1090276750Srwatson if (!(MCLGET(m_new, M_NOWAIT))) { 1091162321Sglebius device_printf(sc->my_dev, 1092148945Sjhb "no memory for rx list -- packet dropped!\n"); 109393746Sjulian m_freem(m_new); 109493746Sjulian return (ENOBUFS); 109593746Sjulian } 109693746Sjulian c->my_mbuf = m_new; 109793746Sjulian c->my_ptr->my_data = vtophys(mtod(m_new, caddr_t)); 109893746Sjulian c->my_ptr->my_ctl = (MCLBYTES - 1) << MY_RBSShift; 109993746Sjulian c->my_ptr->my_status = MY_OWNByNIC; 110093746Sjulian return (0); 110193746Sjulian} 110293746Sjulian 110393746Sjulian/* 110493746Sjulian * A frame has been uploaded: pass the resulting mbuf chain up to the higher 110593746Sjulian * level protocols. 110693746Sjulian */ 110793746Sjulianstatic void 110893746Sjulianmy_rxeof(struct my_softc * sc) 110993746Sjulian{ 111093746Sjulian struct ether_header *eh; 111193746Sjulian struct mbuf *m; 111293746Sjulian struct ifnet *ifp; 111393746Sjulian struct my_chain_onefrag *cur_rx; 111493746Sjulian int total_len = 0; 111593746Sjulian u_int32_t rxstat; 111693746Sjulian 1117149151Sjhb MY_LOCK_ASSERT(sc); 1118147256Sbrooks ifp = sc->my_ifp; 111993746Sjulian while (!((rxstat = sc->my_cdata.my_rx_head->my_ptr->my_status) 112093746Sjulian & MY_OWNByNIC)) { 112193746Sjulian cur_rx = sc->my_cdata.my_rx_head; 112293746Sjulian sc->my_cdata.my_rx_head = cur_rx->my_nextdesc; 112393746Sjulian 112493746Sjulian if (rxstat & MY_ES) { /* error summary: give up this rx pkt */ 1125271827Sglebius if_inc_counter(ifp, IFCOUNTER_IERRORS, 1); 112693746Sjulian cur_rx->my_ptr->my_status = MY_OWNByNIC; 112793746Sjulian continue; 112893746Sjulian } 112993746Sjulian /* No errors; receive the packet. */ 113093746Sjulian total_len = (rxstat & MY_FLNGMASK) >> MY_FLNGShift; 113193746Sjulian total_len -= ETHER_CRC_LEN; 113293746Sjulian 113393746Sjulian if (total_len < MINCLSIZE) { 113493746Sjulian m = m_devget(mtod(cur_rx->my_mbuf, char *), 113593746Sjulian total_len, 0, ifp, NULL); 113693746Sjulian cur_rx->my_ptr->my_status = MY_OWNByNIC; 113793746Sjulian if (m == NULL) { 1138271827Sglebius if_inc_counter(ifp, IFCOUNTER_IERRORS, 1); 113993746Sjulian continue; 114093746Sjulian } 114193746Sjulian } else { 114293746Sjulian m = cur_rx->my_mbuf; 114393746Sjulian /* 114493746Sjulian * Try to conjure up a new mbuf cluster. If that 114593746Sjulian * fails, it means we have an out of memory condition 114693746Sjulian * and should leave the buffer in place and continue. 114793746Sjulian * This will result in a lost packet, but there's 114893746Sjulian * little else we can do in this situation. 114993746Sjulian */ 115093746Sjulian if (my_newbuf(sc, cur_rx) == ENOBUFS) { 1151271827Sglebius if_inc_counter(ifp, IFCOUNTER_IERRORS, 1); 115293746Sjulian cur_rx->my_ptr->my_status = MY_OWNByNIC; 115393746Sjulian continue; 115493746Sjulian } 115593746Sjulian m->m_pkthdr.rcvif = ifp; 115693746Sjulian m->m_pkthdr.len = m->m_len = total_len; 115793746Sjulian } 1158271827Sglebius if_inc_counter(ifp, IFCOUNTER_IPACKETS, 1); 115993746Sjulian eh = mtod(m, struct ether_header *); 116093746Sjulian#if NBPFILTER > 0 116193746Sjulian /* 116293746Sjulian * Handle BPF listeners. Let the BPF user see the packet, but 116393746Sjulian * don't pass it up to the ether_input() layer unless it's a 116493746Sjulian * broadcast packet, multicast packet, matches our ethernet 116593746Sjulian * address or the interface is in promiscuous mode. 116693746Sjulian */ 1167165632Sjhb if (bpf_peers_present(ifp->if_bpf)) { 1168165640Sjhb bpf_mtap(ifp->if_bpf, m); 116993746Sjulian if (ifp->if_flags & IFF_PROMISC && 1170152315Sru (bcmp(eh->ether_dhost, IF_LLADDR(sc->my_ifp), 117193746Sjulian ETHER_ADDR_LEN) && 117293746Sjulian (eh->ether_dhost[0] & 1) == 0)) { 117393746Sjulian m_freem(m); 117493746Sjulian continue; 117593746Sjulian } 117693746Sjulian } 117793746Sjulian#endif 1178122689Ssam MY_UNLOCK(sc); 1179106937Ssam (*ifp->if_input)(ifp, m); 1180122689Ssam MY_LOCK(sc); 118193746Sjulian } 118293746Sjulian return; 118393746Sjulian} 118493746Sjulian 118593746Sjulian 118693746Sjulian/* 118793746Sjulian * A frame was downloaded to the chip. It's safe for us to clean up the list 118893746Sjulian * buffers. 118993746Sjulian */ 119093746Sjulianstatic void 119193746Sjulianmy_txeof(struct my_softc * sc) 119293746Sjulian{ 119393746Sjulian struct my_chain *cur_tx; 119493746Sjulian struct ifnet *ifp; 119593746Sjulian 1196149151Sjhb MY_LOCK_ASSERT(sc); 1197147256Sbrooks ifp = sc->my_ifp; 119893746Sjulian /* Clear the timeout timer. */ 1199199540Sjhb sc->my_timer = 0; 120095939Sjulian if (sc->my_cdata.my_tx_head == NULL) { 120193746Sjulian return; 120295939Sjulian } 120393746Sjulian /* 120493746Sjulian * Go through our tx list and free mbufs for those frames that have 120593746Sjulian * been transmitted. 120693746Sjulian */ 120793746Sjulian while (sc->my_cdata.my_tx_head->my_mbuf != NULL) { 120893746Sjulian u_int32_t txstat; 120993746Sjulian 121093746Sjulian cur_tx = sc->my_cdata.my_tx_head; 121193746Sjulian txstat = MY_TXSTATUS(cur_tx); 121293746Sjulian if ((txstat & MY_OWNByNIC) || txstat == MY_UNSENT) 121393746Sjulian break; 121493746Sjulian if (!(CSR_READ_4(sc, MY_TCRRCR) & MY_Enhanced)) { 121593746Sjulian if (txstat & MY_TXERR) { 1216271827Sglebius if_inc_counter(ifp, IFCOUNTER_OERRORS, 1); 121793746Sjulian if (txstat & MY_EC) /* excessive collision */ 1218271827Sglebius if_inc_counter(ifp, IFCOUNTER_COLLISIONS, 1); 121993746Sjulian if (txstat & MY_LC) /* late collision */ 1220271827Sglebius if_inc_counter(ifp, IFCOUNTER_COLLISIONS, 1); 122193746Sjulian } 1222271827Sglebius if_inc_counter(ifp, IFCOUNTER_COLLISIONS, 1223271827Sglebius (txstat & MY_NCRMASK) >> MY_NCRShift); 122493746Sjulian } 1225271827Sglebius if_inc_counter(ifp, IFCOUNTER_OPACKETS, 1); 122693746Sjulian m_freem(cur_tx->my_mbuf); 122793746Sjulian cur_tx->my_mbuf = NULL; 122893746Sjulian if (sc->my_cdata.my_tx_head == sc->my_cdata.my_tx_tail) { 122993746Sjulian sc->my_cdata.my_tx_head = NULL; 123093746Sjulian sc->my_cdata.my_tx_tail = NULL; 123193746Sjulian break; 123293746Sjulian } 123393746Sjulian sc->my_cdata.my_tx_head = cur_tx->my_nextdesc; 123493746Sjulian } 123593746Sjulian if (CSR_READ_4(sc, MY_TCRRCR) & MY_Enhanced) { 1236271827Sglebius if_inc_counter(ifp, IFCOUNTER_COLLISIONS, (CSR_READ_4(sc, MY_TSR) & MY_NCRMask)); 123793746Sjulian } 123893746Sjulian return; 123993746Sjulian} 124093746Sjulian 124193746Sjulian/* 124293746Sjulian * TX 'end of channel' interrupt handler. 124393746Sjulian */ 124493746Sjulianstatic void 124593746Sjulianmy_txeoc(struct my_softc * sc) 124693746Sjulian{ 124793746Sjulian struct ifnet *ifp; 124893746Sjulian 1249149151Sjhb MY_LOCK_ASSERT(sc); 1250147256Sbrooks ifp = sc->my_ifp; 1251199540Sjhb sc->my_timer = 0; 125293746Sjulian if (sc->my_cdata.my_tx_head == NULL) { 1253148887Srwatson ifp->if_drv_flags &= ~IFF_DRV_OACTIVE; 125493746Sjulian sc->my_cdata.my_tx_tail = NULL; 125593746Sjulian if (sc->my_want_auto) 125693746Sjulian my_autoneg_mii(sc, MY_FLAG_SCHEDDELAY, 1); 125793746Sjulian } else { 125893746Sjulian if (MY_TXOWN(sc->my_cdata.my_tx_head) == MY_UNSENT) { 125993746Sjulian MY_TXOWN(sc->my_cdata.my_tx_head) = MY_OWNByNIC; 1260199540Sjhb sc->my_timer = 5; 126193746Sjulian CSR_WRITE_4(sc, MY_TXPDR, 0xFFFFFFFF); 126293746Sjulian } 126393746Sjulian } 126493746Sjulian return; 126593746Sjulian} 126693746Sjulian 126793746Sjulianstatic void 126893746Sjulianmy_intr(void *arg) 126993746Sjulian{ 127093746Sjulian struct my_softc *sc; 127193746Sjulian struct ifnet *ifp; 127293746Sjulian u_int32_t status; 127393746Sjulian 127493746Sjulian sc = arg; 127593746Sjulian MY_LOCK(sc); 1276147256Sbrooks ifp = sc->my_ifp; 127793746Sjulian if (!(ifp->if_flags & IFF_UP)) { 127893746Sjulian MY_UNLOCK(sc); 127993746Sjulian return; 128093746Sjulian } 128193746Sjulian /* Disable interrupts. */ 128293746Sjulian CSR_WRITE_4(sc, MY_IMR, 0x00000000); 128393746Sjulian 128493746Sjulian for (;;) { 128593746Sjulian status = CSR_READ_4(sc, MY_ISR); 128693746Sjulian status &= MY_INTRS; 128793746Sjulian if (status) 128893746Sjulian CSR_WRITE_4(sc, MY_ISR, status); 128993746Sjulian else 129093746Sjulian break; 129193746Sjulian 129293746Sjulian if (status & MY_RI) /* receive interrupt */ 129393746Sjulian my_rxeof(sc); 129493746Sjulian 129593746Sjulian if ((status & MY_RBU) || (status & MY_RxErr)) { 129693746Sjulian /* rx buffer unavailable or rx error */ 1297271827Sglebius if_inc_counter(ifp, IFCOUNTER_IERRORS, 1); 129893746Sjulian#ifdef foo 129993746Sjulian my_stop(sc); 130093746Sjulian my_reset(sc); 1301149151Sjhb my_init_locked(sc); 130293746Sjulian#endif 130393746Sjulian } 130493746Sjulian if (status & MY_TI) /* tx interrupt */ 130593746Sjulian my_txeof(sc); 130693746Sjulian if (status & MY_ETI) /* tx early interrupt */ 130793746Sjulian my_txeof(sc); 130893746Sjulian if (status & MY_TBU) /* tx buffer unavailable */ 130993746Sjulian my_txeoc(sc); 131094863Sjulian 131194863Sjulian#if 0 /* 90/1/18 delete */ 131294863Sjulian if (status & MY_FBE) { 131394863Sjulian my_reset(sc); 1314149151Sjhb my_init_locked(sc); 131594863Sjulian } 131694863Sjulian#endif 131794863Sjulian 131893746Sjulian } 131993746Sjulian 132093746Sjulian /* Re-enable interrupts. */ 132193746Sjulian CSR_WRITE_4(sc, MY_IMR, MY_INTRS); 1322159291Sbrueffer if (!IFQ_DRV_IS_EMPTY(&ifp->if_snd)) 1323149151Sjhb my_start_locked(ifp); 132493746Sjulian MY_UNLOCK(sc); 132593746Sjulian return; 132693746Sjulian} 132793746Sjulian 132893746Sjulian/* 132993746Sjulian * Encapsulate an mbuf chain in a descriptor by coupling the mbuf data 133093746Sjulian * pointers to the fragment pointers. 133193746Sjulian */ 133293746Sjulianstatic int 133393746Sjulianmy_encap(struct my_softc * sc, struct my_chain * c, struct mbuf * m_head) 133493746Sjulian{ 133593746Sjulian struct my_desc *f = NULL; 133693746Sjulian int total_len; 133793746Sjulian struct mbuf *m, *m_new = NULL; 133893746Sjulian 1339149151Sjhb MY_LOCK_ASSERT(sc); 134093746Sjulian /* calculate the total tx pkt length */ 134193746Sjulian total_len = 0; 134293746Sjulian for (m = m_head; m != NULL; m = m->m_next) 134393746Sjulian total_len += m->m_len; 134493746Sjulian /* 134593746Sjulian * Start packing the mbufs in this chain into the fragment pointers. 134693746Sjulian * Stop when we run out of fragments or hit the end of the mbuf 134793746Sjulian * chain. 134893746Sjulian */ 134993746Sjulian m = m_head; 1350243857Sglebius MGETHDR(m_new, M_NOWAIT, MT_DATA); 135193746Sjulian if (m_new == NULL) { 1352162321Sglebius device_printf(sc->my_dev, "no memory for tx list"); 135393746Sjulian return (1); 135493746Sjulian } 135593746Sjulian if (m_head->m_pkthdr.len > MHLEN) { 1356276750Srwatson if (!(MCLGET(m_new, M_NOWAIT))) { 135793746Sjulian m_freem(m_new); 1358162321Sglebius device_printf(sc->my_dev, "no memory for tx list"); 135993746Sjulian return (1); 136093746Sjulian } 136193746Sjulian } 136293746Sjulian m_copydata(m_head, 0, m_head->m_pkthdr.len, mtod(m_new, caddr_t)); 136393746Sjulian m_new->m_pkthdr.len = m_new->m_len = m_head->m_pkthdr.len; 136493746Sjulian m_freem(m_head); 136593746Sjulian m_head = m_new; 136693746Sjulian f = &c->my_ptr->my_frag[0]; 136793746Sjulian f->my_status = 0; 136893746Sjulian f->my_data = vtophys(mtod(m_new, caddr_t)); 136993746Sjulian total_len = m_new->m_len; 137093746Sjulian f->my_ctl = MY_TXFD | MY_TXLD | MY_CRCEnable | MY_PADEnable; 137193746Sjulian f->my_ctl |= total_len << MY_PKTShift; /* pkt size */ 137293746Sjulian f->my_ctl |= total_len; /* buffer size */ 137394904Sjulian /* 89/12/29 add, for mtd891 *//* [ 89? ] */ 137493746Sjulian if (sc->my_info->my_did == MTD891ID) 137593746Sjulian f->my_ctl |= MY_ETIControl | MY_RetryTxLC; 137693746Sjulian c->my_mbuf = m_head; 137793746Sjulian c->my_lastdesc = 0; 137893746Sjulian MY_TXNEXT(c) = vtophys(&c->my_nextdesc->my_ptr->my_frag[0]); 137993746Sjulian return (0); 138093746Sjulian} 138193746Sjulian 138293746Sjulian/* 138393746Sjulian * Main transmit routine. To avoid having to do mbuf copies, we put pointers 138493746Sjulian * to the mbuf data regions directly in the transmit lists. We also save a 138593746Sjulian * copy of the pointers since the transmit list fragment pointers are 138693746Sjulian * physical addresses. 138793746Sjulian */ 138893746Sjulianstatic void 138993746Sjulianmy_start(struct ifnet * ifp) 139093746Sjulian{ 139193746Sjulian struct my_softc *sc; 1392149151Sjhb 1393149151Sjhb sc = ifp->if_softc; 1394149151Sjhb MY_LOCK(sc); 1395149151Sjhb my_start_locked(ifp); 1396149151Sjhb MY_UNLOCK(sc); 1397149151Sjhb} 1398149151Sjhb 1399149151Sjhbstatic void 1400149151Sjhbmy_start_locked(struct ifnet * ifp) 1401149151Sjhb{ 1402149151Sjhb struct my_softc *sc; 140393746Sjulian struct mbuf *m_head = NULL; 140493746Sjulian struct my_chain *cur_tx = NULL, *start_tx; 140593746Sjulian 140693746Sjulian sc = ifp->if_softc; 1407149151Sjhb MY_LOCK_ASSERT(sc); 140893746Sjulian if (sc->my_autoneg) { 140993746Sjulian sc->my_tx_pend = 1; 141093746Sjulian return; 141193746Sjulian } 141293746Sjulian /* 141393746Sjulian * Check for an available queue slot. If there are none, punt. 141493746Sjulian */ 141593746Sjulian if (sc->my_cdata.my_tx_free->my_mbuf != NULL) { 1416148887Srwatson ifp->if_drv_flags |= IFF_DRV_OACTIVE; 141793746Sjulian return; 141893746Sjulian } 141993746Sjulian start_tx = sc->my_cdata.my_tx_free; 142093746Sjulian while (sc->my_cdata.my_tx_free->my_mbuf == NULL) { 1421159291Sbrueffer IFQ_DRV_DEQUEUE(&ifp->if_snd, m_head); 142293746Sjulian if (m_head == NULL) 142393746Sjulian break; 142493746Sjulian 142593746Sjulian /* Pick a descriptor off the free list. */ 142693746Sjulian cur_tx = sc->my_cdata.my_tx_free; 142793746Sjulian sc->my_cdata.my_tx_free = cur_tx->my_nextdesc; 142893746Sjulian 142993746Sjulian /* Pack the data into the descriptor. */ 143093746Sjulian my_encap(sc, cur_tx, m_head); 143193746Sjulian 143293746Sjulian if (cur_tx != start_tx) 143393746Sjulian MY_TXOWN(cur_tx) = MY_OWNByNIC; 143493746Sjulian#if NBPFILTER > 0 143593746Sjulian /* 143693746Sjulian * If there's a BPF listener, bounce a copy of this frame to 143793746Sjulian * him. 143893746Sjulian */ 1439106937Ssam BPF_MTAP(ifp, cur_tx->my_mbuf); 144093746Sjulian#endif 144193746Sjulian } 144293746Sjulian /* 144393746Sjulian * If there are no packets queued, bail. 144493746Sjulian */ 144593746Sjulian if (cur_tx == NULL) { 144693746Sjulian return; 144793746Sjulian } 144893746Sjulian /* 144993746Sjulian * Place the request for the upload interrupt in the last descriptor 145093746Sjulian * in the chain. This way, if we're chaining several packets at once, 1451172568Skevlo * we'll only get an interrupt once for the whole chain rather than 145293746Sjulian * once for each packet. 145393746Sjulian */ 145493746Sjulian MY_TXCTL(cur_tx) |= MY_TXIC; 145593746Sjulian cur_tx->my_ptr->my_frag[0].my_ctl |= MY_TXIC; 145693746Sjulian sc->my_cdata.my_tx_tail = cur_tx; 145793746Sjulian if (sc->my_cdata.my_tx_head == NULL) 145893746Sjulian sc->my_cdata.my_tx_head = start_tx; 145993746Sjulian MY_TXOWN(start_tx) = MY_OWNByNIC; 146093746Sjulian CSR_WRITE_4(sc, MY_TXPDR, 0xFFFFFFFF); /* tx polling demand */ 146193746Sjulian 146293746Sjulian /* 146393746Sjulian * Set a timeout in case the chip goes out to lunch. 146493746Sjulian */ 1465199540Sjhb sc->my_timer = 5; 146693746Sjulian return; 146793746Sjulian} 146893746Sjulian 146993746Sjulianstatic void 147093746Sjulianmy_init(void *xsc) 147193746Sjulian{ 147293746Sjulian struct my_softc *sc = xsc; 1473149151Sjhb 1474149151Sjhb MY_LOCK(sc); 1475149151Sjhb my_init_locked(sc); 1476149151Sjhb MY_UNLOCK(sc); 1477149151Sjhb} 1478149151Sjhb 1479149151Sjhbstatic void 1480149151Sjhbmy_init_locked(struct my_softc *sc) 1481149151Sjhb{ 1482147256Sbrooks struct ifnet *ifp = sc->my_ifp; 148393746Sjulian u_int16_t phy_bmcr = 0; 148493746Sjulian 1485149151Sjhb MY_LOCK_ASSERT(sc); 148693746Sjulian if (sc->my_autoneg) { 148793746Sjulian return; 148893746Sjulian } 148993746Sjulian if (sc->my_pinfo != NULL) 149093746Sjulian phy_bmcr = my_phy_readreg(sc, PHY_BMCR); 149193746Sjulian /* 149293746Sjulian * Cancel pending I/O and free all RX/TX buffers. 149393746Sjulian */ 149493746Sjulian my_stop(sc); 149593746Sjulian my_reset(sc); 149693746Sjulian 149793746Sjulian /* 149893746Sjulian * Set cache alignment and burst length. 149993746Sjulian */ 150094863Sjulian#if 0 /* 89/9/1 modify, */ 150194863Sjulian CSR_WRITE_4(sc, MY_BCR, MY_RPBLE512); 150294863Sjulian CSR_WRITE_4(sc, MY_TCRRCR, MY_TFTSF); 150394863Sjulian#endif 150493746Sjulian CSR_WRITE_4(sc, MY_BCR, MY_PBL8); 150593746Sjulian CSR_WRITE_4(sc, MY_TCRRCR, MY_TFTSF | MY_RBLEN | MY_RPBLE512); 150693746Sjulian /* 150793746Sjulian * 89/12/29 add, for mtd891, 150893746Sjulian */ 150993746Sjulian if (sc->my_info->my_did == MTD891ID) { 151093746Sjulian MY_SETBIT(sc, MY_BCR, MY_PROG); 151193746Sjulian MY_SETBIT(sc, MY_TCRRCR, MY_Enhanced); 151293746Sjulian } 151393746Sjulian my_setcfg(sc, phy_bmcr); 151493746Sjulian /* Init circular RX list. */ 151593746Sjulian if (my_list_rx_init(sc) == ENOBUFS) { 1516162321Sglebius device_printf(sc->my_dev, "init failed: no memory for rx buffers\n"); 151793746Sjulian my_stop(sc); 151893746Sjulian return; 151993746Sjulian } 152093746Sjulian /* Init TX descriptors. */ 152193746Sjulian my_list_tx_init(sc); 152293746Sjulian 152393746Sjulian /* If we want promiscuous mode, set the allframes bit. */ 152493746Sjulian if (ifp->if_flags & IFF_PROMISC) 152593746Sjulian MY_SETBIT(sc, MY_TCRRCR, MY_PROM); 152693746Sjulian else 152793746Sjulian MY_CLRBIT(sc, MY_TCRRCR, MY_PROM); 152893746Sjulian 152993746Sjulian /* 153093746Sjulian * Set capture broadcast bit to capture broadcast frames. 153193746Sjulian */ 153293746Sjulian if (ifp->if_flags & IFF_BROADCAST) 153393746Sjulian MY_SETBIT(sc, MY_TCRRCR, MY_AB); 153493746Sjulian else 153593746Sjulian MY_CLRBIT(sc, MY_TCRRCR, MY_AB); 153693746Sjulian 153793746Sjulian /* 153893746Sjulian * Program the multicast filter, if necessary. 153993746Sjulian */ 154093746Sjulian my_setmulti(sc); 154193746Sjulian 154293746Sjulian /* 154393746Sjulian * Load the address of the RX list. 154493746Sjulian */ 154593746Sjulian MY_CLRBIT(sc, MY_TCRRCR, MY_RE); 154693746Sjulian CSR_WRITE_4(sc, MY_RXLBA, vtophys(&sc->my_ldata->my_rx_list[0])); 154793746Sjulian 154893746Sjulian /* 154993746Sjulian * Enable interrupts. 155093746Sjulian */ 155193746Sjulian CSR_WRITE_4(sc, MY_IMR, MY_INTRS); 155293746Sjulian CSR_WRITE_4(sc, MY_ISR, 0xFFFFFFFF); 155393746Sjulian 155493746Sjulian /* Enable receiver and transmitter. */ 155593746Sjulian MY_SETBIT(sc, MY_TCRRCR, MY_RE); 155693746Sjulian MY_CLRBIT(sc, MY_TCRRCR, MY_TE); 155793746Sjulian CSR_WRITE_4(sc, MY_TXLBA, vtophys(&sc->my_ldata->my_tx_list[0])); 155893746Sjulian MY_SETBIT(sc, MY_TCRRCR, MY_TE); 155993746Sjulian 156093746Sjulian /* Restore state of BMCR */ 156193746Sjulian if (sc->my_pinfo != NULL) 156293746Sjulian my_phy_writereg(sc, PHY_BMCR, phy_bmcr); 1563148887Srwatson ifp->if_drv_flags |= IFF_DRV_RUNNING; 1564148887Srwatson ifp->if_drv_flags &= ~IFF_DRV_OACTIVE; 1565199540Sjhb 1566199540Sjhb callout_reset(&sc->my_watchdog, hz, my_watchdog, sc); 156793746Sjulian return; 156893746Sjulian} 156993746Sjulian 157093746Sjulian/* 157193746Sjulian * Set media options. 157293746Sjulian */ 157393746Sjulian 157493746Sjulianstatic int 157593746Sjulianmy_ifmedia_upd(struct ifnet * ifp) 157693746Sjulian{ 157793746Sjulian struct my_softc *sc; 157893746Sjulian struct ifmedia *ifm; 157993746Sjulian 158093746Sjulian sc = ifp->if_softc; 158193746Sjulian MY_LOCK(sc); 158293746Sjulian ifm = &sc->ifmedia; 158393746Sjulian if (IFM_TYPE(ifm->ifm_media) != IFM_ETHER) { 158493746Sjulian MY_UNLOCK(sc); 158593746Sjulian return (EINVAL); 158693746Sjulian } 158793746Sjulian if (IFM_SUBTYPE(ifm->ifm_media) == IFM_AUTO) 158893746Sjulian my_autoneg_mii(sc, MY_FLAG_SCHEDDELAY, 1); 158993746Sjulian else 159093746Sjulian my_setmode_mii(sc, ifm->ifm_media); 159193746Sjulian MY_UNLOCK(sc); 159293746Sjulian return (0); 159393746Sjulian} 159493746Sjulian 159593746Sjulian/* 159693746Sjulian * Report current media status. 159793746Sjulian */ 159893746Sjulian 159993746Sjulianstatic void 160093746Sjulianmy_ifmedia_sts(struct ifnet * ifp, struct ifmediareq * ifmr) 160193746Sjulian{ 160293746Sjulian struct my_softc *sc; 160393746Sjulian u_int16_t advert = 0, ability = 0; 160493746Sjulian 160593746Sjulian sc = ifp->if_softc; 160693746Sjulian MY_LOCK(sc); 160793746Sjulian ifmr->ifm_active = IFM_ETHER; 160893746Sjulian if (!(my_phy_readreg(sc, PHY_BMCR) & PHY_BMCR_AUTONEGENBL)) { 160994863Sjulian#if 0 /* this version did not support 1000M, */ 161094863Sjulian if (my_phy_readreg(sc, PHY_BMCR) & PHY_BMCR_1000) 161194863Sjulian ifmr->ifm_active = IFM_ETHER | IFM_1000TX; 161294863Sjulian#endif 161393746Sjulian if (my_phy_readreg(sc, PHY_BMCR) & PHY_BMCR_SPEEDSEL) 161493746Sjulian ifmr->ifm_active = IFM_ETHER | IFM_100_TX; 161593746Sjulian else 161693746Sjulian ifmr->ifm_active = IFM_ETHER | IFM_10_T; 161793746Sjulian if (my_phy_readreg(sc, PHY_BMCR) & PHY_BMCR_DUPLEX) 161893746Sjulian ifmr->ifm_active |= IFM_FDX; 161993746Sjulian else 162093746Sjulian ifmr->ifm_active |= IFM_HDX; 162193746Sjulian 162293746Sjulian MY_UNLOCK(sc); 162393746Sjulian return; 162493746Sjulian } 162593746Sjulian ability = my_phy_readreg(sc, PHY_LPAR); 162693746Sjulian advert = my_phy_readreg(sc, PHY_ANAR); 162793746Sjulian 162894863Sjulian#if 0 /* this version did not support 1000M, */ 162993746Sjulian if (sc->my_pinfo->my_vid = MarvellPHYID0) { 163093746Sjulian ability2 = my_phy_readreg(sc, PHY_1000SR); 163193746Sjulian if (ability2 & PHY_1000SR_1000BTXFULL) { 163293746Sjulian advert = 0; 163393746Sjulian ability = 0; 163495673Sphk ifmr->ifm_active = IFM_ETHER|IFM_1000_T|IFM_FDX; 163593746Sjulian } else if (ability & PHY_1000SR_1000BTXHALF) { 163693746Sjulian advert = 0; 163793746Sjulian ability = 0; 163895673Sphk ifmr->ifm_active = IFM_ETHER|IFM_1000_T|IFM_HDX; 163993746Sjulian } 164093746Sjulian } 164193746Sjulian#endif 164293746Sjulian if (advert & PHY_ANAR_100BT4 && ability & PHY_ANAR_100BT4) 164393746Sjulian ifmr->ifm_active = IFM_ETHER | IFM_100_T4; 164493746Sjulian else if (advert & PHY_ANAR_100BTXFULL && ability & PHY_ANAR_100BTXFULL) 164593746Sjulian ifmr->ifm_active = IFM_ETHER | IFM_100_TX | IFM_FDX; 164693746Sjulian else if (advert & PHY_ANAR_100BTXHALF && ability & PHY_ANAR_100BTXHALF) 164793746Sjulian ifmr->ifm_active = IFM_ETHER | IFM_100_TX | IFM_HDX; 164893746Sjulian else if (advert & PHY_ANAR_10BTFULL && ability & PHY_ANAR_10BTFULL) 164993746Sjulian ifmr->ifm_active = IFM_ETHER | IFM_10_T | IFM_FDX; 165093746Sjulian else if (advert & PHY_ANAR_10BTHALF && ability & PHY_ANAR_10BTHALF) 165193746Sjulian ifmr->ifm_active = IFM_ETHER | IFM_10_T | IFM_HDX; 165293746Sjulian MY_UNLOCK(sc); 165393746Sjulian return; 165493746Sjulian} 165593746Sjulian 165693746Sjulianstatic int 165793746Sjulianmy_ioctl(struct ifnet * ifp, u_long command, caddr_t data) 165893746Sjulian{ 165993746Sjulian struct my_softc *sc = ifp->if_softc; 166093746Sjulian struct ifreq *ifr = (struct ifreq *) data; 1661149151Sjhb int error; 166293746Sjulian 166393746Sjulian switch (command) { 166493746Sjulian case SIOCSIFFLAGS: 1665149151Sjhb MY_LOCK(sc); 166693746Sjulian if (ifp->if_flags & IFF_UP) 1667149151Sjhb my_init_locked(sc); 1668148887Srwatson else if (ifp->if_drv_flags & IFF_DRV_RUNNING) 166993746Sjulian my_stop(sc); 1670149151Sjhb MY_UNLOCK(sc); 167193746Sjulian error = 0; 167293746Sjulian break; 167393746Sjulian case SIOCADDMULTI: 167493746Sjulian case SIOCDELMULTI: 1675149151Sjhb MY_LOCK(sc); 167693746Sjulian my_setmulti(sc); 1677149151Sjhb MY_UNLOCK(sc); 167893746Sjulian error = 0; 167993746Sjulian break; 168093746Sjulian case SIOCGIFMEDIA: 168193746Sjulian case SIOCSIFMEDIA: 168293746Sjulian error = ifmedia_ioctl(ifp, ifr, &sc->ifmedia, command); 168393746Sjulian break; 168493746Sjulian default: 1685106937Ssam error = ether_ioctl(ifp, command, data); 168693746Sjulian break; 168793746Sjulian } 168893746Sjulian return (error); 168993746Sjulian} 169093746Sjulian 169193746Sjulianstatic void 1692199540Sjhbmy_watchdog(void *arg) 169393746Sjulian{ 169493746Sjulian struct my_softc *sc; 1695199540Sjhb struct ifnet *ifp; 169693746Sjulian 1697199540Sjhb sc = arg; 1698199540Sjhb MY_LOCK_ASSERT(sc); 1699199540Sjhb callout_reset(&sc->my_watchdog, hz, my_watchdog, sc); 1700199540Sjhb if (sc->my_timer == 0 || --sc->my_timer > 0) 170193746Sjulian return; 1702199540Sjhb 1703199540Sjhb ifp = sc->my_ifp; 1704271827Sglebius if_inc_counter(ifp, IFCOUNTER_OERRORS, 1); 1705148945Sjhb if_printf(ifp, "watchdog timeout\n"); 170693746Sjulian if (!(my_phy_readreg(sc, PHY_BMSR) & PHY_BMSR_LINKSTAT)) 1707148945Sjhb if_printf(ifp, "no carrier - transceiver cable problem?\n"); 170893746Sjulian my_stop(sc); 170993746Sjulian my_reset(sc); 1710149151Sjhb my_init_locked(sc); 1711159291Sbrueffer if (!IFQ_DRV_IS_EMPTY(&ifp->if_snd)) 1712149151Sjhb my_start_locked(ifp); 171393746Sjulian} 171493746Sjulian 171593746Sjulian 171693746Sjulian/* 171793746Sjulian * Stop the adapter and free any mbufs allocated to the RX and TX lists. 171893746Sjulian */ 171993746Sjulianstatic void 172093746Sjulianmy_stop(struct my_softc * sc) 172193746Sjulian{ 1722331643Sdim int i; 172393746Sjulian struct ifnet *ifp; 172493746Sjulian 1725149151Sjhb MY_LOCK_ASSERT(sc); 1726147256Sbrooks ifp = sc->my_ifp; 172793746Sjulian 1728199540Sjhb callout_stop(&sc->my_autoneg_timer); 1729199540Sjhb callout_stop(&sc->my_watchdog); 1730199540Sjhb 173193746Sjulian MY_CLRBIT(sc, MY_TCRRCR, (MY_RE | MY_TE)); 173293746Sjulian CSR_WRITE_4(sc, MY_IMR, 0x00000000); 173393746Sjulian CSR_WRITE_4(sc, MY_TXLBA, 0x00000000); 173493746Sjulian CSR_WRITE_4(sc, MY_RXLBA, 0x00000000); 173593746Sjulian 173693746Sjulian /* 173793746Sjulian * Free data in the RX lists. 173893746Sjulian */ 173993746Sjulian for (i = 0; i < MY_RX_LIST_CNT; i++) { 174093746Sjulian if (sc->my_cdata.my_rx_chain[i].my_mbuf != NULL) { 174193746Sjulian m_freem(sc->my_cdata.my_rx_chain[i].my_mbuf); 174293746Sjulian sc->my_cdata.my_rx_chain[i].my_mbuf = NULL; 174393746Sjulian } 174493746Sjulian } 174593746Sjulian bzero((char *)&sc->my_ldata->my_rx_list, 174693746Sjulian sizeof(sc->my_ldata->my_rx_list)); 174793746Sjulian /* 174893746Sjulian * Free the TX list buffers. 174993746Sjulian */ 175093746Sjulian for (i = 0; i < MY_TX_LIST_CNT; i++) { 175193746Sjulian if (sc->my_cdata.my_tx_chain[i].my_mbuf != NULL) { 175293746Sjulian m_freem(sc->my_cdata.my_tx_chain[i].my_mbuf); 175393746Sjulian sc->my_cdata.my_tx_chain[i].my_mbuf = NULL; 175493746Sjulian } 175593746Sjulian } 175693746Sjulian bzero((char *)&sc->my_ldata->my_tx_list, 175793746Sjulian sizeof(sc->my_ldata->my_tx_list)); 1758148887Srwatson ifp->if_drv_flags &= ~(IFF_DRV_RUNNING | IFF_DRV_OACTIVE); 175993746Sjulian return; 176093746Sjulian} 176193746Sjulian 176293746Sjulian/* 176393746Sjulian * Stop all chip I/O so that the kernel's probe routines don't get confused 176493746Sjulian * by errant DMAs when rebooting. 176593746Sjulian */ 1766188172Simpstatic int 176793746Sjulianmy_shutdown(device_t dev) 176893746Sjulian{ 176993746Sjulian struct my_softc *sc; 177093746Sjulian 177193746Sjulian sc = device_get_softc(dev); 1772149151Sjhb MY_LOCK(sc); 177393746Sjulian my_stop(sc); 1774149151Sjhb MY_UNLOCK(sc); 1775188172Simp return 0; 177693746Sjulian} 1777