if_my.c revision 195049
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 195049 2009-06-26 11:45:06Z rwatson $"); 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 *); 12993746Sjulianstatic void my_watchdog(struct ifnet *); 130188172Simpstatic int my_shutdown(device_t); 13193746Sjulianstatic int my_ifmedia_upd(struct ifnet *); 13293746Sjulianstatic void my_ifmedia_sts(struct ifnet *, struct ifmediareq *); 13393746Sjulianstatic u_int16_t my_phy_readreg(struct my_softc *, int); 13493746Sjulianstatic void my_phy_writereg(struct my_softc *, int, int); 13593746Sjulianstatic void my_autoneg_xmit(struct my_softc *); 13693746Sjulianstatic void my_autoneg_mii(struct my_softc *, int, int); 13793746Sjulianstatic void my_setmode_mii(struct my_softc *, int); 13893746Sjulianstatic void my_getmode_mii(struct my_softc *); 13993746Sjulianstatic void my_setcfg(struct my_softc *, int); 14093746Sjulianstatic void my_setmulti(struct my_softc *); 14193746Sjulianstatic void my_reset(struct my_softc *); 14293746Sjulianstatic int my_list_rx_init(struct my_softc *); 14393746Sjulianstatic int my_list_tx_init(struct my_softc *); 14493746Sjulianstatic long my_send_cmd_to_phy(struct my_softc *, int, int); 14593746Sjulian 146106696Salfred#define MY_SETBIT(sc, reg, x) CSR_WRITE_4(sc, reg, CSR_READ_4(sc, reg) | (x)) 147106696Salfred#define MY_CLRBIT(sc, reg, x) CSR_WRITE_4(sc, reg, CSR_READ_4(sc, reg) & ~(x)) 14893746Sjulian 14993746Sjulianstatic device_method_t my_methods[] = { 15093746Sjulian /* Device interface */ 15193746Sjulian DEVMETHOD(device_probe, my_probe), 15293746Sjulian DEVMETHOD(device_attach, my_attach), 15393746Sjulian DEVMETHOD(device_detach, my_detach), 15493746Sjulian DEVMETHOD(device_shutdown, my_shutdown), 15593746Sjulian 15693746Sjulian {0, 0} 15793746Sjulian}; 15893746Sjulian 15993746Sjulianstatic driver_t my_driver = { 16093746Sjulian "my", 16193746Sjulian my_methods, 16293746Sjulian sizeof(struct my_softc) 16393746Sjulian}; 16493746Sjulian 16593746Sjulianstatic devclass_t my_devclass; 16693746Sjulian 167113506SmdoddDRIVER_MODULE(my, pci, my_driver, my_devclass, 0, 0); 168113506SmdoddMODULE_DEPEND(my, pci, 1, 1, 1); 169113506SmdoddMODULE_DEPEND(my, ether, 1, 1, 1); 17093746Sjulian 17193746Sjulianstatic long 17293746Sjulianmy_send_cmd_to_phy(struct my_softc * sc, int opcode, int regad) 17393746Sjulian{ 17493746Sjulian long miir; 17593746Sjulian int i; 17693746Sjulian int mask, data; 17793746Sjulian 178149151Sjhb MY_LOCK_ASSERT(sc); 17993746Sjulian 18093746Sjulian /* enable MII output */ 18193746Sjulian miir = CSR_READ_4(sc, MY_MANAGEMENT); 18293746Sjulian miir &= 0xfffffff0; 18393746Sjulian 18493746Sjulian miir |= MY_MASK_MIIR_MII_WRITE + MY_MASK_MIIR_MII_MDO; 18593746Sjulian 18693746Sjulian /* send 32 1's preamble */ 18793746Sjulian for (i = 0; i < 32; i++) { 18893746Sjulian /* low MDC; MDO is already high (miir) */ 18993746Sjulian miir &= ~MY_MASK_MIIR_MII_MDC; 19093746Sjulian CSR_WRITE_4(sc, MY_MANAGEMENT, miir); 19193746Sjulian 19293746Sjulian /* high MDC */ 19393746Sjulian miir |= MY_MASK_MIIR_MII_MDC; 19493746Sjulian CSR_WRITE_4(sc, MY_MANAGEMENT, miir); 19593746Sjulian } 19693746Sjulian 19793746Sjulian /* calculate ST+OP+PHYAD+REGAD+TA */ 19893746Sjulian data = opcode | (sc->my_phy_addr << 7) | (regad << 2); 19993746Sjulian 20093746Sjulian /* sent out */ 20193746Sjulian mask = 0x8000; 20293746Sjulian while (mask) { 20393746Sjulian /* low MDC, prepare MDO */ 20493746Sjulian miir &= ~(MY_MASK_MIIR_MII_MDC + MY_MASK_MIIR_MII_MDO); 20593746Sjulian if (mask & data) 20693746Sjulian miir |= MY_MASK_MIIR_MII_MDO; 20793746Sjulian 20893746Sjulian CSR_WRITE_4(sc, MY_MANAGEMENT, miir); 20993746Sjulian /* high MDC */ 21093746Sjulian miir |= MY_MASK_MIIR_MII_MDC; 21193746Sjulian CSR_WRITE_4(sc, MY_MANAGEMENT, miir); 21293746Sjulian DELAY(30); 21393746Sjulian 21493746Sjulian /* next */ 21593746Sjulian mask >>= 1; 21693746Sjulian if (mask == 0x2 && opcode == MY_OP_READ) 21793746Sjulian miir &= ~MY_MASK_MIIR_MII_WRITE; 21893746Sjulian } 21993746Sjulian 22093746Sjulian return miir; 22193746Sjulian} 22293746Sjulian 22393746Sjulian 224148945Sjhbstatic u_int16_t 22593746Sjulianmy_phy_readreg(struct my_softc * sc, int reg) 22693746Sjulian{ 22793746Sjulian long miir; 22893746Sjulian int mask, data; 22993746Sjulian 230149151Sjhb MY_LOCK_ASSERT(sc); 23193746Sjulian 23293746Sjulian if (sc->my_info->my_did == MTD803ID) 23393746Sjulian data = CSR_READ_2(sc, MY_PHYBASE + reg * 2); 23493746Sjulian else { 23593746Sjulian miir = my_send_cmd_to_phy(sc, MY_OP_READ, reg); 23693746Sjulian 23793746Sjulian /* read data */ 23893746Sjulian mask = 0x8000; 23993746Sjulian data = 0; 24093746Sjulian while (mask) { 24193746Sjulian /* low MDC */ 24293746Sjulian miir &= ~MY_MASK_MIIR_MII_MDC; 24393746Sjulian CSR_WRITE_4(sc, MY_MANAGEMENT, miir); 24493746Sjulian 24593746Sjulian /* read MDI */ 24693746Sjulian miir = CSR_READ_4(sc, MY_MANAGEMENT); 24793746Sjulian if (miir & MY_MASK_MIIR_MII_MDI) 24893746Sjulian data |= mask; 24993746Sjulian 25093746Sjulian /* high MDC, and wait */ 25193746Sjulian miir |= MY_MASK_MIIR_MII_MDC; 25293746Sjulian CSR_WRITE_4(sc, MY_MANAGEMENT, miir); 25393746Sjulian DELAY(30); 25493746Sjulian 25593746Sjulian /* next */ 25693746Sjulian mask >>= 1; 25793746Sjulian } 25893746Sjulian 25993746Sjulian /* low MDC */ 26093746Sjulian miir &= ~MY_MASK_MIIR_MII_MDC; 26193746Sjulian CSR_WRITE_4(sc, MY_MANAGEMENT, miir); 26293746Sjulian } 26393746Sjulian 26493746Sjulian return (u_int16_t) data; 26593746Sjulian} 26693746Sjulian 26793746Sjulian 26893746Sjulianstatic void 26993746Sjulianmy_phy_writereg(struct my_softc * sc, int reg, int data) 27093746Sjulian{ 27193746Sjulian long miir; 27293746Sjulian int mask; 27393746Sjulian 274149151Sjhb MY_LOCK_ASSERT(sc); 27593746Sjulian 27693746Sjulian if (sc->my_info->my_did == MTD803ID) 27793746Sjulian CSR_WRITE_2(sc, MY_PHYBASE + reg * 2, data); 27893746Sjulian else { 27993746Sjulian miir = my_send_cmd_to_phy(sc, MY_OP_WRITE, reg); 28093746Sjulian 28193746Sjulian /* write data */ 28293746Sjulian mask = 0x8000; 28393746Sjulian while (mask) { 28493746Sjulian /* low MDC, prepare MDO */ 28593746Sjulian miir &= ~(MY_MASK_MIIR_MII_MDC + MY_MASK_MIIR_MII_MDO); 28693746Sjulian if (mask & data) 28793746Sjulian miir |= MY_MASK_MIIR_MII_MDO; 28893746Sjulian CSR_WRITE_4(sc, MY_MANAGEMENT, miir); 28993746Sjulian DELAY(1); 29093746Sjulian 29193746Sjulian /* high MDC */ 29293746Sjulian miir |= MY_MASK_MIIR_MII_MDC; 29393746Sjulian CSR_WRITE_4(sc, MY_MANAGEMENT, miir); 29493746Sjulian DELAY(1); 29593746Sjulian 29693746Sjulian /* next */ 29793746Sjulian mask >>= 1; 29893746Sjulian } 29993746Sjulian 30093746Sjulian /* low MDC */ 30193746Sjulian miir &= ~MY_MASK_MIIR_MII_MDC; 30293746Sjulian CSR_WRITE_4(sc, MY_MANAGEMENT, miir); 30393746Sjulian } 30493746Sjulian return; 30593746Sjulian} 30693746Sjulian 30793746Sjulian 30893746Sjulian/* 30993746Sjulian * Program the 64-bit multicast hash filter. 31093746Sjulian */ 31193746Sjulianstatic void 31293746Sjulianmy_setmulti(struct my_softc * sc) 31393746Sjulian{ 31493746Sjulian struct ifnet *ifp; 31593746Sjulian int h = 0; 31693746Sjulian u_int32_t hashes[2] = {0, 0}; 31793746Sjulian struct ifmultiaddr *ifma; 31893746Sjulian u_int32_t rxfilt; 31993746Sjulian int mcnt = 0; 32093746Sjulian 321149151Sjhb MY_LOCK_ASSERT(sc); 32293746Sjulian 323147256Sbrooks ifp = sc->my_ifp; 32493746Sjulian 32593746Sjulian rxfilt = CSR_READ_4(sc, MY_TCRRCR); 32693746Sjulian 32793746Sjulian if (ifp->if_flags & IFF_ALLMULTI || ifp->if_flags & IFF_PROMISC) { 32893746Sjulian rxfilt |= MY_AM; 32993746Sjulian CSR_WRITE_4(sc, MY_TCRRCR, rxfilt); 33093746Sjulian CSR_WRITE_4(sc, MY_MAR0, 0xFFFFFFFF); 33193746Sjulian CSR_WRITE_4(sc, MY_MAR1, 0xFFFFFFFF); 33293746Sjulian 33393746Sjulian return; 33493746Sjulian } 33593746Sjulian /* first, zot all the existing hash bits */ 33693746Sjulian CSR_WRITE_4(sc, MY_MAR0, 0); 33793746Sjulian CSR_WRITE_4(sc, MY_MAR1, 0); 33893746Sjulian 33993746Sjulian /* now program new ones */ 340195049Srwatson if_maddr_rlock(ifp); 34193746Sjulian TAILQ_FOREACH(ifma, &ifp->if_multiaddrs, ifma_link) { 34293746Sjulian if (ifma->ifma_addr->sa_family != AF_LINK) 34393746Sjulian continue; 344130270Snaddy h = ~ether_crc32_be(LLADDR((struct sockaddr_dl *) 345130270Snaddy ifma->ifma_addr), ETHER_ADDR_LEN) >> 26; 34693746Sjulian if (h < 32) 34793746Sjulian hashes[0] |= (1 << h); 34893746Sjulian else 34993746Sjulian hashes[1] |= (1 << (h - 32)); 35093746Sjulian mcnt++; 35193746Sjulian } 352195049Srwatson if_maddr_runlock(ifp); 35393746Sjulian 35493746Sjulian if (mcnt) 35593746Sjulian rxfilt |= MY_AM; 35693746Sjulian else 35793746Sjulian rxfilt &= ~MY_AM; 35893746Sjulian CSR_WRITE_4(sc, MY_MAR0, hashes[0]); 35993746Sjulian CSR_WRITE_4(sc, MY_MAR1, hashes[1]); 36093746Sjulian CSR_WRITE_4(sc, MY_TCRRCR, rxfilt); 36193746Sjulian return; 36293746Sjulian} 36393746Sjulian 36493746Sjulian/* 36593746Sjulian * Initiate an autonegotiation session. 36693746Sjulian */ 36793746Sjulianstatic void 36893746Sjulianmy_autoneg_xmit(struct my_softc * sc) 36993746Sjulian{ 37093746Sjulian u_int16_t phy_sts = 0; 37193746Sjulian 372149151Sjhb MY_LOCK_ASSERT(sc); 37393746Sjulian 37493746Sjulian my_phy_writereg(sc, PHY_BMCR, PHY_BMCR_RESET); 37593746Sjulian DELAY(500); 37693746Sjulian while (my_phy_readreg(sc, PHY_BMCR) & PHY_BMCR_RESET); 37793746Sjulian 37893746Sjulian phy_sts = my_phy_readreg(sc, PHY_BMCR); 37993746Sjulian phy_sts |= PHY_BMCR_AUTONEGENBL | PHY_BMCR_AUTONEGRSTR; 38093746Sjulian my_phy_writereg(sc, PHY_BMCR, phy_sts); 38193746Sjulian 38293746Sjulian return; 38393746Sjulian} 38493746Sjulian 38593746Sjulian 38693746Sjulian/* 38793746Sjulian * Invoke autonegotiation on a PHY. 38893746Sjulian */ 38993746Sjulianstatic void 39093746Sjulianmy_autoneg_mii(struct my_softc * sc, int flag, int verbose) 39193746Sjulian{ 39293746Sjulian u_int16_t phy_sts = 0, media, advert, ability; 39393746Sjulian u_int16_t ability2 = 0; 39493746Sjulian struct ifnet *ifp; 39593746Sjulian struct ifmedia *ifm; 39693746Sjulian 397149151Sjhb MY_LOCK_ASSERT(sc); 39893746Sjulian 39993746Sjulian ifm = &sc->ifmedia; 400147256Sbrooks ifp = sc->my_ifp; 40193746Sjulian 40293746Sjulian ifm->ifm_media = IFM_ETHER | IFM_AUTO; 40393746Sjulian 40493746Sjulian#ifndef FORCE_AUTONEG_TFOUR 40593746Sjulian /* 40693746Sjulian * First, see if autoneg is supported. If not, there's no point in 40793746Sjulian * continuing. 40893746Sjulian */ 40993746Sjulian phy_sts = my_phy_readreg(sc, PHY_BMSR); 41093746Sjulian if (!(phy_sts & PHY_BMSR_CANAUTONEG)) { 41193746Sjulian if (verbose) 412162321Sglebius device_printf(sc->my_dev, 413162321Sglebius "autonegotiation not supported\n"); 41493746Sjulian ifm->ifm_media = IFM_ETHER | IFM_10_T | IFM_HDX; 41593746Sjulian return; 41693746Sjulian } 41793746Sjulian#endif 41893746Sjulian switch (flag) { 41993746Sjulian case MY_FLAG_FORCEDELAY: 42093746Sjulian /* 42193746Sjulian * XXX Never use this option anywhere but in the probe 42293746Sjulian * routine: making the kernel stop dead in its tracks for 42393746Sjulian * three whole seconds after we've gone multi-user is really 42493746Sjulian * bad manners. 42593746Sjulian */ 42693746Sjulian my_autoneg_xmit(sc); 42793746Sjulian DELAY(5000000); 42893746Sjulian break; 42993746Sjulian case MY_FLAG_SCHEDDELAY: 43093746Sjulian /* 43193746Sjulian * Wait for the transmitter to go idle before starting an 43293746Sjulian * autoneg session, otherwise my_start() may clobber our 43393746Sjulian * timeout, and we don't want to allow transmission during an 43493746Sjulian * autoneg session since that can screw it up. 43593746Sjulian */ 43693746Sjulian if (sc->my_cdata.my_tx_head != NULL) { 43793746Sjulian sc->my_want_auto = 1; 43893746Sjulian MY_UNLOCK(sc); 43993746Sjulian return; 44093746Sjulian } 44193746Sjulian my_autoneg_xmit(sc); 44293746Sjulian ifp->if_timer = 5; 44393746Sjulian sc->my_autoneg = 1; 44493746Sjulian sc->my_want_auto = 0; 44593746Sjulian return; 44693746Sjulian case MY_FLAG_DELAYTIMEO: 44793746Sjulian ifp->if_timer = 0; 44893746Sjulian sc->my_autoneg = 0; 44993746Sjulian break; 45093746Sjulian default: 451162321Sglebius device_printf(sc->my_dev, "invalid autoneg flag: %d\n", flag); 45293746Sjulian return; 45393746Sjulian } 45493746Sjulian 45593746Sjulian if (my_phy_readreg(sc, PHY_BMSR) & PHY_BMSR_AUTONEGCOMP) { 45693746Sjulian if (verbose) 457162321Sglebius device_printf(sc->my_dev, "autoneg complete, "); 45893746Sjulian phy_sts = my_phy_readreg(sc, PHY_BMSR); 45993746Sjulian } else { 46093746Sjulian if (verbose) 461162321Sglebius device_printf(sc->my_dev, "autoneg not complete, "); 46293746Sjulian } 46393746Sjulian 46493746Sjulian media = my_phy_readreg(sc, PHY_BMCR); 46593746Sjulian 46693746Sjulian /* Link is good. Report modes and set duplex mode. */ 46793746Sjulian if (my_phy_readreg(sc, PHY_BMSR) & PHY_BMSR_LINKSTAT) { 46893746Sjulian if (verbose) 469162321Sglebius device_printf(sc->my_dev, "link status good. "); 47093746Sjulian advert = my_phy_readreg(sc, PHY_ANAR); 47193746Sjulian ability = my_phy_readreg(sc, PHY_LPAR); 47293746Sjulian if ((sc->my_pinfo->my_vid == MarvellPHYID0) || 47393746Sjulian (sc->my_pinfo->my_vid == LevelOnePHYID0)) { 47493746Sjulian ability2 = my_phy_readreg(sc, PHY_1000SR); 47593746Sjulian if (ability2 & PHY_1000SR_1000BTXFULL) { 47693746Sjulian advert = 0; 47793746Sjulian ability = 0; 47893746Sjulian /* 47993746Sjulian * this version did not support 1000M, 48093746Sjulian * ifm->ifm_media = 48195673Sphk * IFM_ETHER|IFM_1000_T|IFM_FDX; 48293746Sjulian */ 48393746Sjulian ifm->ifm_media = 48493746Sjulian IFM_ETHER | IFM_100_TX | IFM_FDX; 48593746Sjulian media &= ~PHY_BMCR_SPEEDSEL; 48693746Sjulian media |= PHY_BMCR_1000; 48793746Sjulian media |= PHY_BMCR_DUPLEX; 48893746Sjulian printf("(full-duplex, 1000Mbps)\n"); 48993746Sjulian } else if (ability2 & PHY_1000SR_1000BTXHALF) { 49093746Sjulian advert = 0; 49193746Sjulian ability = 0; 49293746Sjulian /* 49393746Sjulian * this version did not support 1000M, 49495673Sphk * ifm->ifm_media = IFM_ETHER|IFM_1000_T; 49593746Sjulian */ 49693746Sjulian ifm->ifm_media = IFM_ETHER | IFM_100_TX; 49793746Sjulian media &= ~PHY_BMCR_SPEEDSEL; 49893746Sjulian media &= ~PHY_BMCR_DUPLEX; 49993746Sjulian media |= PHY_BMCR_1000; 50093746Sjulian printf("(half-duplex, 1000Mbps)\n"); 50193746Sjulian } 50293746Sjulian } 50393746Sjulian if (advert & PHY_ANAR_100BT4 && ability & PHY_ANAR_100BT4) { 50493746Sjulian ifm->ifm_media = IFM_ETHER | IFM_100_T4; 50593746Sjulian media |= PHY_BMCR_SPEEDSEL; 50693746Sjulian media &= ~PHY_BMCR_DUPLEX; 50793746Sjulian printf("(100baseT4)\n"); 50893746Sjulian } else if (advert & PHY_ANAR_100BTXFULL && 50993746Sjulian ability & PHY_ANAR_100BTXFULL) { 51093746Sjulian ifm->ifm_media = IFM_ETHER | IFM_100_TX | IFM_FDX; 51193746Sjulian media |= PHY_BMCR_SPEEDSEL; 51293746Sjulian media |= PHY_BMCR_DUPLEX; 51393746Sjulian printf("(full-duplex, 100Mbps)\n"); 51493746Sjulian } else if (advert & PHY_ANAR_100BTXHALF && 51593746Sjulian ability & PHY_ANAR_100BTXHALF) { 51693746Sjulian ifm->ifm_media = IFM_ETHER | IFM_100_TX | IFM_HDX; 51793746Sjulian media |= PHY_BMCR_SPEEDSEL; 51893746Sjulian media &= ~PHY_BMCR_DUPLEX; 51993746Sjulian printf("(half-duplex, 100Mbps)\n"); 52093746Sjulian } else if (advert & PHY_ANAR_10BTFULL && 52193746Sjulian ability & PHY_ANAR_10BTFULL) { 52293746Sjulian ifm->ifm_media = IFM_ETHER | IFM_10_T | IFM_FDX; 52393746Sjulian media &= ~PHY_BMCR_SPEEDSEL; 52493746Sjulian media |= PHY_BMCR_DUPLEX; 52593746Sjulian printf("(full-duplex, 10Mbps)\n"); 52693746Sjulian } else if (advert) { 52793746Sjulian ifm->ifm_media = IFM_ETHER | IFM_10_T | IFM_HDX; 52893746Sjulian media &= ~PHY_BMCR_SPEEDSEL; 52993746Sjulian media &= ~PHY_BMCR_DUPLEX; 53093746Sjulian printf("(half-duplex, 10Mbps)\n"); 53193746Sjulian } 53293746Sjulian media &= ~PHY_BMCR_AUTONEGENBL; 53393746Sjulian 53493746Sjulian /* Set ASIC's duplex mode to match the PHY. */ 53593746Sjulian my_phy_writereg(sc, PHY_BMCR, media); 53693746Sjulian my_setcfg(sc, media); 53793746Sjulian } else { 53893746Sjulian if (verbose) 539162321Sglebius device_printf(sc->my_dev, "no carrier\n"); 54093746Sjulian } 54193746Sjulian 542149151Sjhb my_init_locked(sc); 54393746Sjulian if (sc->my_tx_pend) { 54493746Sjulian sc->my_autoneg = 0; 54593746Sjulian sc->my_tx_pend = 0; 546149151Sjhb my_start_locked(ifp); 54793746Sjulian } 54893746Sjulian return; 54993746Sjulian} 55093746Sjulian 55193746Sjulian/* 55293746Sjulian * To get PHY ability. 55393746Sjulian */ 55493746Sjulianstatic void 55593746Sjulianmy_getmode_mii(struct my_softc * sc) 55693746Sjulian{ 55793746Sjulian u_int16_t bmsr; 55893746Sjulian struct ifnet *ifp; 55993746Sjulian 560149151Sjhb MY_LOCK_ASSERT(sc); 561147256Sbrooks ifp = sc->my_ifp; 56293746Sjulian bmsr = my_phy_readreg(sc, PHY_BMSR); 56393746Sjulian if (bootverbose) 564162321Sglebius device_printf(sc->my_dev, "PHY status word: %x\n", bmsr); 56593746Sjulian 56693746Sjulian /* fallback */ 56793746Sjulian sc->ifmedia.ifm_media = IFM_ETHER | IFM_10_T | IFM_HDX; 56893746Sjulian 56993746Sjulian if (bmsr & PHY_BMSR_10BTHALF) { 57093746Sjulian if (bootverbose) 571162321Sglebius device_printf(sc->my_dev, 572162321Sglebius "10Mbps half-duplex mode supported\n"); 57393746Sjulian ifmedia_add(&sc->ifmedia, IFM_ETHER | IFM_10_T | IFM_HDX, 57493746Sjulian 0, NULL); 57593746Sjulian ifmedia_add(&sc->ifmedia, IFM_ETHER | IFM_10_T, 0, NULL); 57693746Sjulian } 57793746Sjulian if (bmsr & PHY_BMSR_10BTFULL) { 57893746Sjulian if (bootverbose) 579162321Sglebius device_printf(sc->my_dev, 580162321Sglebius "10Mbps full-duplex mode supported\n"); 58193746Sjulian 58293746Sjulian ifmedia_add(&sc->ifmedia, IFM_ETHER | IFM_10_T | IFM_FDX, 58393746Sjulian 0, NULL); 58493746Sjulian sc->ifmedia.ifm_media = IFM_ETHER | IFM_10_T | IFM_FDX; 58593746Sjulian } 58693746Sjulian if (bmsr & PHY_BMSR_100BTXHALF) { 58793746Sjulian if (bootverbose) 588162321Sglebius device_printf(sc->my_dev, 589162321Sglebius "100Mbps half-duplex mode supported\n"); 59093746Sjulian ifp->if_baudrate = 100000000; 59193746Sjulian ifmedia_add(&sc->ifmedia, IFM_ETHER | IFM_100_TX, 0, NULL); 59293746Sjulian ifmedia_add(&sc->ifmedia, IFM_ETHER | IFM_100_TX | IFM_HDX, 59393746Sjulian 0, NULL); 59493746Sjulian sc->ifmedia.ifm_media = IFM_ETHER | IFM_100_TX | IFM_HDX; 59593746Sjulian } 59693746Sjulian if (bmsr & PHY_BMSR_100BTXFULL) { 59793746Sjulian if (bootverbose) 598162321Sglebius device_printf(sc->my_dev, 599162321Sglebius "100Mbps full-duplex mode supported\n"); 60093746Sjulian ifp->if_baudrate = 100000000; 60193746Sjulian ifmedia_add(&sc->ifmedia, IFM_ETHER | IFM_100_TX | IFM_FDX, 60293746Sjulian 0, NULL); 60393746Sjulian sc->ifmedia.ifm_media = IFM_ETHER | IFM_100_TX | IFM_FDX; 60493746Sjulian } 60593746Sjulian /* Some also support 100BaseT4. */ 60693746Sjulian if (bmsr & PHY_BMSR_100BT4) { 60793746Sjulian if (bootverbose) 608162321Sglebius device_printf(sc->my_dev, "100baseT4 mode supported\n"); 60993746Sjulian ifp->if_baudrate = 100000000; 61093746Sjulian ifmedia_add(&sc->ifmedia, IFM_ETHER | IFM_100_T4, 0, NULL); 61193746Sjulian sc->ifmedia.ifm_media = IFM_ETHER | IFM_100_T4; 61293746Sjulian#ifdef FORCE_AUTONEG_TFOUR 61393746Sjulian if (bootverbose) 614162321Sglebius device_printf(sc->my_dev, 615162321Sglebius "forcing on autoneg support for BT4\n"); 61693746Sjulian ifmedia_add(&sc->ifmedia, IFM_ETHER | IFM_AUTO, 0 NULL): 61793746Sjulian sc->ifmedia.ifm_media = IFM_ETHER | IFM_AUTO; 61893746Sjulian#endif 61993746Sjulian } 62094863Sjulian#if 0 /* this version did not support 1000M, */ 62193746Sjulian if (sc->my_pinfo->my_vid == MarvellPHYID0) { 62293746Sjulian if (bootverbose) 623162321Sglebius device_printf(sc->my_dev, 624162321Sglebius "1000Mbps half-duplex mode supported\n"); 62593746Sjulian 62693746Sjulian ifp->if_baudrate = 1000000000; 62795673Sphk ifmedia_add(&sc->ifmedia, IFM_ETHER | IFM_1000_T, 0, NULL); 62895673Sphk ifmedia_add(&sc->ifmedia, IFM_ETHER | IFM_1000_T | IFM_HDX, 62993746Sjulian 0, NULL); 63093746Sjulian if (bootverbose) 631162321Sglebius device_printf(sc->my_dev, 632162321Sglebius "1000Mbps full-duplex mode supported\n"); 63393746Sjulian ifp->if_baudrate = 1000000000; 63495673Sphk ifmedia_add(&sc->ifmedia, IFM_ETHER | IFM_1000_T | IFM_FDX, 63593746Sjulian 0, NULL); 63695673Sphk sc->ifmedia.ifm_media = IFM_ETHER | IFM_1000_T | IFM_FDX; 63793746Sjulian } 63893746Sjulian#endif 63993746Sjulian if (bmsr & PHY_BMSR_CANAUTONEG) { 64093746Sjulian if (bootverbose) 641162321Sglebius device_printf(sc->my_dev, "autoneg supported\n"); 64293746Sjulian ifmedia_add(&sc->ifmedia, IFM_ETHER | IFM_AUTO, 0, NULL); 64393746Sjulian sc->ifmedia.ifm_media = IFM_ETHER | IFM_AUTO; 64493746Sjulian } 64593746Sjulian return; 64693746Sjulian} 64793746Sjulian 64893746Sjulian/* 64993746Sjulian * Set speed and duplex mode. 65093746Sjulian */ 65193746Sjulianstatic void 65293746Sjulianmy_setmode_mii(struct my_softc * sc, int media) 65393746Sjulian{ 65493746Sjulian u_int16_t bmcr; 65593746Sjulian struct ifnet *ifp; 65693746Sjulian 657149151Sjhb MY_LOCK_ASSERT(sc); 658147256Sbrooks ifp = sc->my_ifp; 65993746Sjulian /* 66093746Sjulian * If an autoneg session is in progress, stop it. 66193746Sjulian */ 66293746Sjulian if (sc->my_autoneg) { 663162321Sglebius device_printf(sc->my_dev, "canceling autoneg session\n"); 66493746Sjulian ifp->if_timer = sc->my_autoneg = sc->my_want_auto = 0; 66593746Sjulian bmcr = my_phy_readreg(sc, PHY_BMCR); 66693746Sjulian bmcr &= ~PHY_BMCR_AUTONEGENBL; 66793746Sjulian my_phy_writereg(sc, PHY_BMCR, bmcr); 66893746Sjulian } 669162321Sglebius device_printf(sc->my_dev, "selecting MII, "); 67093746Sjulian bmcr = my_phy_readreg(sc, PHY_BMCR); 67193746Sjulian bmcr &= ~(PHY_BMCR_AUTONEGENBL | PHY_BMCR_SPEEDSEL | PHY_BMCR_1000 | 67293746Sjulian PHY_BMCR_DUPLEX | PHY_BMCR_LOOPBK); 67394863Sjulian 67494863Sjulian#if 0 /* this version did not support 1000M, */ 67595673Sphk if (IFM_SUBTYPE(media) == IFM_1000_T) { 67693746Sjulian printf("1000Mbps/T4, half-duplex\n"); 67793746Sjulian bmcr &= ~PHY_BMCR_SPEEDSEL; 67893746Sjulian bmcr &= ~PHY_BMCR_DUPLEX; 67993746Sjulian bmcr |= PHY_BMCR_1000; 68093746Sjulian } 68193746Sjulian#endif 68293746Sjulian if (IFM_SUBTYPE(media) == IFM_100_T4) { 68393746Sjulian printf("100Mbps/T4, half-duplex\n"); 68493746Sjulian bmcr |= PHY_BMCR_SPEEDSEL; 68593746Sjulian bmcr &= ~PHY_BMCR_DUPLEX; 68693746Sjulian } 68793746Sjulian if (IFM_SUBTYPE(media) == IFM_100_TX) { 68893746Sjulian printf("100Mbps, "); 68993746Sjulian bmcr |= PHY_BMCR_SPEEDSEL; 69093746Sjulian } 69193746Sjulian if (IFM_SUBTYPE(media) == IFM_10_T) { 69293746Sjulian printf("10Mbps, "); 69393746Sjulian bmcr &= ~PHY_BMCR_SPEEDSEL; 69493746Sjulian } 69593746Sjulian if ((media & IFM_GMASK) == IFM_FDX) { 69693746Sjulian printf("full duplex\n"); 69793746Sjulian bmcr |= PHY_BMCR_DUPLEX; 69893746Sjulian } else { 69993746Sjulian printf("half duplex\n"); 70093746Sjulian bmcr &= ~PHY_BMCR_DUPLEX; 70193746Sjulian } 70293746Sjulian my_phy_writereg(sc, PHY_BMCR, bmcr); 70393746Sjulian my_setcfg(sc, bmcr); 70493746Sjulian return; 70593746Sjulian} 70693746Sjulian 70793746Sjulian/* 70893746Sjulian * The Myson manual states that in order to fiddle with the 'full-duplex' and 70993746Sjulian * '100Mbps' bits in the netconfig register, we first have to put the 71093746Sjulian * transmit and/or receive logic in the idle state. 71193746Sjulian */ 71293746Sjulianstatic void 71393746Sjulianmy_setcfg(struct my_softc * sc, int bmcr) 71493746Sjulian{ 71593746Sjulian int i, restart = 0; 71693746Sjulian 717149151Sjhb MY_LOCK_ASSERT(sc); 71893746Sjulian if (CSR_READ_4(sc, MY_TCRRCR) & (MY_TE | MY_RE)) { 71993746Sjulian restart = 1; 72093746Sjulian MY_CLRBIT(sc, MY_TCRRCR, (MY_TE | MY_RE)); 72193746Sjulian for (i = 0; i < MY_TIMEOUT; i++) { 72293746Sjulian DELAY(10); 72393746Sjulian if (!(CSR_READ_4(sc, MY_TCRRCR) & 72493746Sjulian (MY_TXRUN | MY_RXRUN))) 72593746Sjulian break; 72693746Sjulian } 72793746Sjulian if (i == MY_TIMEOUT) 728162321Sglebius device_printf(sc->my_dev, 729148945Sjhb "failed to force tx and rx to idle \n"); 73093746Sjulian } 73193746Sjulian MY_CLRBIT(sc, MY_TCRRCR, MY_PS1000); 73293746Sjulian MY_CLRBIT(sc, MY_TCRRCR, MY_PS10); 73393746Sjulian if (bmcr & PHY_BMCR_1000) 73493746Sjulian MY_SETBIT(sc, MY_TCRRCR, MY_PS1000); 73593746Sjulian else if (!(bmcr & PHY_BMCR_SPEEDSEL)) 73693746Sjulian MY_SETBIT(sc, MY_TCRRCR, MY_PS10); 73793746Sjulian if (bmcr & PHY_BMCR_DUPLEX) 73893746Sjulian MY_SETBIT(sc, MY_TCRRCR, MY_FD); 73993746Sjulian else 74093746Sjulian MY_CLRBIT(sc, MY_TCRRCR, MY_FD); 74193746Sjulian if (restart) 74293746Sjulian MY_SETBIT(sc, MY_TCRRCR, MY_TE | MY_RE); 74393746Sjulian return; 74493746Sjulian} 74593746Sjulian 74693746Sjulianstatic void 74793746Sjulianmy_reset(struct my_softc * sc) 74893746Sjulian{ 74993746Sjulian register int i; 75093746Sjulian 751149151Sjhb MY_LOCK_ASSERT(sc); 75293746Sjulian MY_SETBIT(sc, MY_BCR, MY_SWR); 75393746Sjulian for (i = 0; i < MY_TIMEOUT; i++) { 75493746Sjulian DELAY(10); 75593746Sjulian if (!(CSR_READ_4(sc, MY_BCR) & MY_SWR)) 75693746Sjulian break; 75793746Sjulian } 75893746Sjulian if (i == MY_TIMEOUT) 759162321Sglebius device_printf(sc->my_dev, "reset never completed!\n"); 76093746Sjulian 76193746Sjulian /* Wait a little while for the chip to get its brains in order. */ 76293746Sjulian DELAY(1000); 76393746Sjulian return; 76493746Sjulian} 76593746Sjulian 76693746Sjulian/* 76793746Sjulian * Probe for a Myson chip. Check the PCI vendor and device IDs against our 76893746Sjulian * list and return a device name if we find a match. 76993746Sjulian */ 77093746Sjulianstatic int 77193746Sjulianmy_probe(device_t dev) 77293746Sjulian{ 77393746Sjulian struct my_type *t; 77493746Sjulian 77593746Sjulian t = my_devs; 77693746Sjulian while (t->my_name != NULL) { 77793746Sjulian if ((pci_get_vendor(dev) == t->my_vid) && 77893746Sjulian (pci_get_device(dev) == t->my_did)) { 77993746Sjulian device_set_desc(dev, t->my_name); 78093746Sjulian my_info_tmp = t; 781143158Simp return (BUS_PROBE_DEFAULT); 78293746Sjulian } 78393746Sjulian t++; 78493746Sjulian } 78593746Sjulian return (ENXIO); 78693746Sjulian} 78793746Sjulian 78893746Sjulian/* 78993746Sjulian * Attach the interface. Allocate softc structures, do ifmedia setup and 79093746Sjulian * ethernet/BPF attach. 79193746Sjulian */ 79293746Sjulianstatic int 79393746Sjulianmy_attach(device_t dev) 79493746Sjulian{ 795149151Sjhb int i; 79693746Sjulian u_char eaddr[ETHER_ADDR_LEN]; 797148946Sjhb u_int32_t iobase; 79893746Sjulian struct my_softc *sc; 79993746Sjulian struct ifnet *ifp; 80093746Sjulian int media = IFM_ETHER | IFM_100_TX | IFM_FDX; 80193746Sjulian unsigned int round; 80293746Sjulian caddr_t roundptr; 80393746Sjulian struct my_type *p; 80493746Sjulian u_int16_t phy_vid, phy_did, phy_sts = 0; 805148945Sjhb int rid, error = 0; 80693746Sjulian 80793746Sjulian sc = device_get_softc(dev); 808162321Sglebius sc->my_dev = dev; 80995803Sjulian mtx_init(&sc->my_mtx, device_get_nameunit(dev), MTX_NETWORK_LOCK, 810149151Sjhb MTX_DEF); 81193746Sjulian 81293746Sjulian /* 81393746Sjulian * Map control/status registers. 81493746Sjulian */ 815148946Sjhb pci_enable_busmaster(dev); 81693746Sjulian 81793746Sjulian if (my_info_tmp->my_did == MTD800ID) { 81893746Sjulian iobase = pci_read_config(dev, MY_PCI_LOIO, 4); 81993746Sjulian if (iobase & 0x300) 82093746Sjulian MY_USEIOSPACE = 0; 82193746Sjulian } 82293746Sjulian 82393746Sjulian rid = MY_RID; 824127135Snjl sc->my_res = bus_alloc_resource_any(dev, MY_RES, &rid, RF_ACTIVE); 82593746Sjulian 82693746Sjulian if (sc->my_res == NULL) { 827148945Sjhb device_printf(dev, "couldn't map ports/memory\n"); 82893746Sjulian error = ENXIO; 829149151Sjhb goto destroy_mutex; 83093746Sjulian } 83193746Sjulian sc->my_btag = rman_get_bustag(sc->my_res); 83293746Sjulian sc->my_bhandle = rman_get_bushandle(sc->my_res); 83393746Sjulian 83493746Sjulian rid = 0; 835127135Snjl sc->my_irq = bus_alloc_resource_any(dev, SYS_RES_IRQ, &rid, 836127135Snjl RF_SHAREABLE | RF_ACTIVE); 83793746Sjulian 83893746Sjulian if (sc->my_irq == NULL) { 839148945Sjhb device_printf(dev, "couldn't map interrupt\n"); 84093746Sjulian error = ENXIO; 841149151Sjhb goto release_io; 84293746Sjulian } 84393746Sjulian 84493746Sjulian sc->my_info = my_info_tmp; 84593746Sjulian 84693746Sjulian /* Reset the adapter. */ 847149151Sjhb MY_LOCK(sc); 84893746Sjulian my_reset(sc); 849149151Sjhb MY_UNLOCK(sc); 85093746Sjulian 85193746Sjulian /* 85293746Sjulian * Get station address 85393746Sjulian */ 85493746Sjulian for (i = 0; i < ETHER_ADDR_LEN; ++i) 85593746Sjulian eaddr[i] = CSR_READ_1(sc, MY_PAR0 + i); 85693746Sjulian 85793746Sjulian sc->my_ldata_ptr = malloc(sizeof(struct my_list_data) + 8, 85893746Sjulian M_DEVBUF, M_NOWAIT); 85993746Sjulian if (sc->my_ldata_ptr == NULL) { 860148945Sjhb device_printf(dev, "no memory for list buffers!\n"); 86193746Sjulian error = ENXIO; 862149151Sjhb goto release_irq; 86393746Sjulian } 86493746Sjulian sc->my_ldata = (struct my_list_data *) sc->my_ldata_ptr; 865106588Sjhb round = (uintptr_t)sc->my_ldata_ptr & 0xF; 86693746Sjulian roundptr = sc->my_ldata_ptr; 86793746Sjulian for (i = 0; i < 8; i++) { 86893746Sjulian if (round % 8) { 86993746Sjulian round++; 87093746Sjulian roundptr++; 87193746Sjulian } else 87293746Sjulian break; 87393746Sjulian } 87493746Sjulian sc->my_ldata = (struct my_list_data *) roundptr; 87593746Sjulian bzero(sc->my_ldata, sizeof(struct my_list_data)); 87693746Sjulian 877147256Sbrooks ifp = sc->my_ifp = if_alloc(IFT_ETHER); 878147256Sbrooks if (ifp == NULL) { 879147256Sbrooks device_printf(dev, "can not if_alloc()\n"); 880147256Sbrooks error = ENOSPC; 881149151Sjhb goto free_ldata; 882147256Sbrooks } 88393746Sjulian ifp->if_softc = sc; 884121816Sbrooks if_initname(ifp, device_get_name(dev), device_get_unit(dev)); 88593746Sjulian ifp->if_mtu = ETHERMTU; 88693746Sjulian ifp->if_flags = IFF_BROADCAST | IFF_SIMPLEX | IFF_MULTICAST; 88793746Sjulian ifp->if_ioctl = my_ioctl; 88893746Sjulian ifp->if_start = my_start; 88993746Sjulian ifp->if_watchdog = my_watchdog; 89093746Sjulian ifp->if_init = my_init; 89193746Sjulian ifp->if_baudrate = 10000000; 892159291Sbrueffer IFQ_SET_MAXLEN(&ifp->if_snd, IFQ_MAXLEN); 893159291Sbrueffer ifp->if_snd.ifq_drv_maxlen = IFQ_MAXLEN; 894159291Sbrueffer IFQ_SET_READY(&ifp->if_snd); 89593746Sjulian 89693746Sjulian if (sc->my_info->my_did == MTD803ID) 89793746Sjulian sc->my_pinfo = my_phys; 89893746Sjulian else { 89993746Sjulian if (bootverbose) 900148945Sjhb device_printf(dev, "probing for a PHY\n"); 901149151Sjhb MY_LOCK(sc); 90293746Sjulian for (i = MY_PHYADDR_MIN; i < MY_PHYADDR_MAX + 1; i++) { 90393746Sjulian if (bootverbose) 904148945Sjhb device_printf(dev, "checking address: %d\n", i); 90593746Sjulian sc->my_phy_addr = i; 90693746Sjulian phy_sts = my_phy_readreg(sc, PHY_BMSR); 90793746Sjulian if ((phy_sts != 0) && (phy_sts != 0xffff)) 90893746Sjulian break; 90993746Sjulian else 91093746Sjulian phy_sts = 0; 91193746Sjulian } 91293746Sjulian if (phy_sts) { 91393746Sjulian phy_vid = my_phy_readreg(sc, PHY_VENID); 91493746Sjulian phy_did = my_phy_readreg(sc, PHY_DEVID); 91593746Sjulian if (bootverbose) { 916148945Sjhb device_printf(dev, "found PHY at address %d, ", 917148945Sjhb sc->my_phy_addr); 91893746Sjulian printf("vendor id: %x device id: %x\n", 91993746Sjulian phy_vid, phy_did); 92093746Sjulian } 92193746Sjulian p = my_phys; 92293746Sjulian while (p->my_vid) { 92393746Sjulian if (phy_vid == p->my_vid) { 92493746Sjulian sc->my_pinfo = p; 92593746Sjulian break; 92693746Sjulian } 92793746Sjulian p++; 92893746Sjulian } 92993746Sjulian if (sc->my_pinfo == NULL) 93093746Sjulian sc->my_pinfo = &my_phys[PHY_UNKNOWN]; 93193746Sjulian if (bootverbose) 932148945Sjhb device_printf(dev, "PHY type: %s\n", 933148945Sjhb sc->my_pinfo->my_name); 93493746Sjulian } else { 935149151Sjhb MY_UNLOCK(sc); 936148945Sjhb device_printf(dev, "MII without any phy!\n"); 93793746Sjulian error = ENXIO; 938149151Sjhb goto free_if; 93993746Sjulian } 940149151Sjhb MY_UNLOCK(sc); 94193746Sjulian } 94293746Sjulian 94393746Sjulian /* Do ifmedia setup. */ 94493746Sjulian ifmedia_init(&sc->ifmedia, 0, my_ifmedia_upd, my_ifmedia_sts); 945149151Sjhb MY_LOCK(sc); 94693746Sjulian my_getmode_mii(sc); 94793746Sjulian my_autoneg_mii(sc, MY_FLAG_FORCEDELAY, 1); 94893746Sjulian media = sc->ifmedia.ifm_media; 94993746Sjulian my_stop(sc); 950149151Sjhb MY_UNLOCK(sc); 95193746Sjulian ifmedia_set(&sc->ifmedia, media); 95293746Sjulian 953106937Ssam ether_ifattach(ifp, eaddr); 954149151Sjhb 955149151Sjhb error = bus_setup_intr(dev, sc->my_irq, INTR_TYPE_NET | INTR_MPSAFE, 956166901Spiso NULL, my_intr, sc, &sc->my_intrhand); 957149151Sjhb 958149151Sjhb if (error) { 959149151Sjhb device_printf(dev, "couldn't set up irq\n"); 960149151Sjhb goto detach_if; 961149151Sjhb } 96293746Sjulian 96393746Sjulian return (0); 96493746Sjulian 965149151Sjhbdetach_if: 966149151Sjhb ether_ifdetach(ifp); 967149151Sjhbfree_if: 968149151Sjhb if_free(ifp); 969149151Sjhbfree_ldata: 970149151Sjhb free(sc->my_ldata_ptr, M_DEVBUF); 971149151Sjhbrelease_irq: 972149151Sjhb bus_release_resource(dev, SYS_RES_IRQ, 0, sc->my_irq); 973149151Sjhbrelease_io: 974149151Sjhb bus_release_resource(dev, MY_RES, MY_RID, sc->my_res); 975149151Sjhbdestroy_mutex: 97693746Sjulian mtx_destroy(&sc->my_mtx); 97793746Sjulian return (error); 97893746Sjulian} 97993746Sjulian 98093746Sjulianstatic int 98193746Sjulianmy_detach(device_t dev) 98293746Sjulian{ 98393746Sjulian struct my_softc *sc; 98493746Sjulian struct ifnet *ifp; 98593746Sjulian 98693746Sjulian sc = device_get_softc(dev); 98793746Sjulian MY_LOCK(sc); 988149151Sjhb my_stop(sc); 989149151Sjhb MY_UNLOCK(sc); 990149151Sjhb bus_teardown_intr(dev, sc->my_irq, sc->my_intrhand); 991149151Sjhb 992147256Sbrooks ifp = sc->my_ifp; 993106937Ssam ether_ifdetach(ifp); 994147256Sbrooks if_free(ifp); 995149151Sjhb free(sc->my_ldata_ptr, M_DEVBUF); 99693746Sjulian 99793746Sjulian bus_release_resource(dev, SYS_RES_IRQ, 0, sc->my_irq); 99893746Sjulian bus_release_resource(dev, MY_RES, MY_RID, sc->my_res); 99993746Sjulian mtx_destroy(&sc->my_mtx); 100093746Sjulian return (0); 100193746Sjulian} 100293746Sjulian 100393746Sjulian 100493746Sjulian/* 100593746Sjulian * Initialize the transmit descriptors. 100693746Sjulian */ 100793746Sjulianstatic int 100893746Sjulianmy_list_tx_init(struct my_softc * sc) 100993746Sjulian{ 101093746Sjulian struct my_chain_data *cd; 101193746Sjulian struct my_list_data *ld; 101293746Sjulian int i; 101393746Sjulian 1014149151Sjhb MY_LOCK_ASSERT(sc); 101593746Sjulian cd = &sc->my_cdata; 101693746Sjulian ld = sc->my_ldata; 101793746Sjulian for (i = 0; i < MY_TX_LIST_CNT; i++) { 101893746Sjulian cd->my_tx_chain[i].my_ptr = &ld->my_tx_list[i]; 101993746Sjulian if (i == (MY_TX_LIST_CNT - 1)) 102093746Sjulian cd->my_tx_chain[i].my_nextdesc = &cd->my_tx_chain[0]; 102193746Sjulian else 102293746Sjulian cd->my_tx_chain[i].my_nextdesc = 102393746Sjulian &cd->my_tx_chain[i + 1]; 102493746Sjulian } 102593746Sjulian cd->my_tx_free = &cd->my_tx_chain[0]; 102693746Sjulian cd->my_tx_tail = cd->my_tx_head = NULL; 102793746Sjulian return (0); 102893746Sjulian} 102993746Sjulian 103093746Sjulian/* 103193746Sjulian * Initialize the RX descriptors and allocate mbufs for them. Note that we 103293746Sjulian * arrange the descriptors in a closed ring, so that the last descriptor 103393746Sjulian * points back to the first. 103493746Sjulian */ 103593746Sjulianstatic int 103693746Sjulianmy_list_rx_init(struct my_softc * sc) 103793746Sjulian{ 103893746Sjulian struct my_chain_data *cd; 103993746Sjulian struct my_list_data *ld; 104093746Sjulian int i; 104193746Sjulian 1042149151Sjhb MY_LOCK_ASSERT(sc); 104393746Sjulian cd = &sc->my_cdata; 104493746Sjulian ld = sc->my_ldata; 104593746Sjulian for (i = 0; i < MY_RX_LIST_CNT; i++) { 104693746Sjulian cd->my_rx_chain[i].my_ptr = 104793746Sjulian (struct my_desc *) & ld->my_rx_list[i]; 104897641Sjulian if (my_newbuf(sc, &cd->my_rx_chain[i]) == ENOBUFS) { 104997641Sjulian MY_UNLOCK(sc); 105093746Sjulian return (ENOBUFS); 105197641Sjulian } 105293746Sjulian if (i == (MY_RX_LIST_CNT - 1)) { 105393746Sjulian cd->my_rx_chain[i].my_nextdesc = &cd->my_rx_chain[0]; 105493746Sjulian ld->my_rx_list[i].my_next = vtophys(&ld->my_rx_list[0]); 105593746Sjulian } else { 105693746Sjulian cd->my_rx_chain[i].my_nextdesc = 105793746Sjulian &cd->my_rx_chain[i + 1]; 105893746Sjulian ld->my_rx_list[i].my_next = 105993746Sjulian vtophys(&ld->my_rx_list[i + 1]); 106093746Sjulian } 106193746Sjulian } 106293746Sjulian cd->my_rx_head = &cd->my_rx_chain[0]; 106393746Sjulian return (0); 106493746Sjulian} 106593746Sjulian 106693746Sjulian/* 106793746Sjulian * Initialize an RX descriptor and attach an MBUF cluster. 106893746Sjulian */ 106993746Sjulianstatic int 107093746Sjulianmy_newbuf(struct my_softc * sc, struct my_chain_onefrag * c) 107193746Sjulian{ 107293746Sjulian struct mbuf *m_new = NULL; 107393746Sjulian 1074149151Sjhb MY_LOCK_ASSERT(sc); 1075111119Simp MGETHDR(m_new, M_DONTWAIT, MT_DATA); 107693746Sjulian if (m_new == NULL) { 1077162321Sglebius device_printf(sc->my_dev, 1078148945Sjhb "no memory for rx list -- packet dropped!\n"); 107993746Sjulian return (ENOBUFS); 108093746Sjulian } 1081111119Simp MCLGET(m_new, M_DONTWAIT); 108293746Sjulian if (!(m_new->m_flags & M_EXT)) { 1083162321Sglebius device_printf(sc->my_dev, 1084148945Sjhb "no memory for rx list -- packet dropped!\n"); 108593746Sjulian m_freem(m_new); 108693746Sjulian return (ENOBUFS); 108793746Sjulian } 108893746Sjulian c->my_mbuf = m_new; 108993746Sjulian c->my_ptr->my_data = vtophys(mtod(m_new, caddr_t)); 109093746Sjulian c->my_ptr->my_ctl = (MCLBYTES - 1) << MY_RBSShift; 109193746Sjulian c->my_ptr->my_status = MY_OWNByNIC; 109293746Sjulian return (0); 109393746Sjulian} 109493746Sjulian 109593746Sjulian/* 109693746Sjulian * A frame has been uploaded: pass the resulting mbuf chain up to the higher 109793746Sjulian * level protocols. 109893746Sjulian */ 109993746Sjulianstatic void 110093746Sjulianmy_rxeof(struct my_softc * sc) 110193746Sjulian{ 110293746Sjulian struct ether_header *eh; 110393746Sjulian struct mbuf *m; 110493746Sjulian struct ifnet *ifp; 110593746Sjulian struct my_chain_onefrag *cur_rx; 110693746Sjulian int total_len = 0; 110793746Sjulian u_int32_t rxstat; 110893746Sjulian 1109149151Sjhb MY_LOCK_ASSERT(sc); 1110147256Sbrooks ifp = sc->my_ifp; 111193746Sjulian while (!((rxstat = sc->my_cdata.my_rx_head->my_ptr->my_status) 111293746Sjulian & MY_OWNByNIC)) { 111393746Sjulian cur_rx = sc->my_cdata.my_rx_head; 111493746Sjulian sc->my_cdata.my_rx_head = cur_rx->my_nextdesc; 111593746Sjulian 111693746Sjulian if (rxstat & MY_ES) { /* error summary: give up this rx pkt */ 111793746Sjulian ifp->if_ierrors++; 111893746Sjulian cur_rx->my_ptr->my_status = MY_OWNByNIC; 111993746Sjulian continue; 112093746Sjulian } 112193746Sjulian /* No errors; receive the packet. */ 112293746Sjulian total_len = (rxstat & MY_FLNGMASK) >> MY_FLNGShift; 112393746Sjulian total_len -= ETHER_CRC_LEN; 112493746Sjulian 112593746Sjulian if (total_len < MINCLSIZE) { 112693746Sjulian m = m_devget(mtod(cur_rx->my_mbuf, char *), 112793746Sjulian total_len, 0, ifp, NULL); 112893746Sjulian cur_rx->my_ptr->my_status = MY_OWNByNIC; 112993746Sjulian if (m == NULL) { 113093746Sjulian ifp->if_ierrors++; 113193746Sjulian continue; 113293746Sjulian } 113393746Sjulian } else { 113493746Sjulian m = cur_rx->my_mbuf; 113593746Sjulian /* 113693746Sjulian * Try to conjure up a new mbuf cluster. If that 113793746Sjulian * fails, it means we have an out of memory condition 113893746Sjulian * and should leave the buffer in place and continue. 113993746Sjulian * This will result in a lost packet, but there's 114093746Sjulian * little else we can do in this situation. 114193746Sjulian */ 114293746Sjulian if (my_newbuf(sc, cur_rx) == ENOBUFS) { 114393746Sjulian ifp->if_ierrors++; 114493746Sjulian cur_rx->my_ptr->my_status = MY_OWNByNIC; 114593746Sjulian continue; 114693746Sjulian } 114793746Sjulian m->m_pkthdr.rcvif = ifp; 114893746Sjulian m->m_pkthdr.len = m->m_len = total_len; 114993746Sjulian } 115093746Sjulian ifp->if_ipackets++; 115193746Sjulian eh = mtod(m, struct ether_header *); 115293746Sjulian#if NBPFILTER > 0 115393746Sjulian /* 115493746Sjulian * Handle BPF listeners. Let the BPF user see the packet, but 115593746Sjulian * don't pass it up to the ether_input() layer unless it's a 115693746Sjulian * broadcast packet, multicast packet, matches our ethernet 115793746Sjulian * address or the interface is in promiscuous mode. 115893746Sjulian */ 1159165632Sjhb if (bpf_peers_present(ifp->if_bpf)) { 1160165640Sjhb bpf_mtap(ifp->if_bpf, m); 116193746Sjulian if (ifp->if_flags & IFF_PROMISC && 1162152315Sru (bcmp(eh->ether_dhost, IF_LLADDR(sc->my_ifp), 116393746Sjulian ETHER_ADDR_LEN) && 116493746Sjulian (eh->ether_dhost[0] & 1) == 0)) { 116593746Sjulian m_freem(m); 116693746Sjulian continue; 116793746Sjulian } 116893746Sjulian } 116993746Sjulian#endif 1170122689Ssam MY_UNLOCK(sc); 1171106937Ssam (*ifp->if_input)(ifp, m); 1172122689Ssam MY_LOCK(sc); 117393746Sjulian } 117493746Sjulian return; 117593746Sjulian} 117693746Sjulian 117793746Sjulian 117893746Sjulian/* 117993746Sjulian * A frame was downloaded to the chip. It's safe for us to clean up the list 118093746Sjulian * buffers. 118193746Sjulian */ 118293746Sjulianstatic void 118393746Sjulianmy_txeof(struct my_softc * sc) 118493746Sjulian{ 118593746Sjulian struct my_chain *cur_tx; 118693746Sjulian struct ifnet *ifp; 118793746Sjulian 1188149151Sjhb MY_LOCK_ASSERT(sc); 1189147256Sbrooks ifp = sc->my_ifp; 119093746Sjulian /* Clear the timeout timer. */ 119193746Sjulian ifp->if_timer = 0; 119295939Sjulian if (sc->my_cdata.my_tx_head == NULL) { 119393746Sjulian return; 119495939Sjulian } 119593746Sjulian /* 119693746Sjulian * Go through our tx list and free mbufs for those frames that have 119793746Sjulian * been transmitted. 119893746Sjulian */ 119993746Sjulian while (sc->my_cdata.my_tx_head->my_mbuf != NULL) { 120093746Sjulian u_int32_t txstat; 120193746Sjulian 120293746Sjulian cur_tx = sc->my_cdata.my_tx_head; 120393746Sjulian txstat = MY_TXSTATUS(cur_tx); 120493746Sjulian if ((txstat & MY_OWNByNIC) || txstat == MY_UNSENT) 120593746Sjulian break; 120693746Sjulian if (!(CSR_READ_4(sc, MY_TCRRCR) & MY_Enhanced)) { 120793746Sjulian if (txstat & MY_TXERR) { 120893746Sjulian ifp->if_oerrors++; 120993746Sjulian if (txstat & MY_EC) /* excessive collision */ 121093746Sjulian ifp->if_collisions++; 121193746Sjulian if (txstat & MY_LC) /* late collision */ 121293746Sjulian ifp->if_collisions++; 121393746Sjulian } 121493746Sjulian ifp->if_collisions += (txstat & MY_NCRMASK) >> 121593746Sjulian MY_NCRShift; 121693746Sjulian } 121793746Sjulian ifp->if_opackets++; 121893746Sjulian m_freem(cur_tx->my_mbuf); 121993746Sjulian cur_tx->my_mbuf = NULL; 122093746Sjulian if (sc->my_cdata.my_tx_head == sc->my_cdata.my_tx_tail) { 122193746Sjulian sc->my_cdata.my_tx_head = NULL; 122293746Sjulian sc->my_cdata.my_tx_tail = NULL; 122393746Sjulian break; 122493746Sjulian } 122593746Sjulian sc->my_cdata.my_tx_head = cur_tx->my_nextdesc; 122693746Sjulian } 122793746Sjulian if (CSR_READ_4(sc, MY_TCRRCR) & MY_Enhanced) { 122893746Sjulian ifp->if_collisions += (CSR_READ_4(sc, MY_TSR) & MY_NCRMask); 122993746Sjulian } 123093746Sjulian return; 123193746Sjulian} 123293746Sjulian 123393746Sjulian/* 123493746Sjulian * TX 'end of channel' interrupt handler. 123593746Sjulian */ 123693746Sjulianstatic void 123793746Sjulianmy_txeoc(struct my_softc * sc) 123893746Sjulian{ 123993746Sjulian struct ifnet *ifp; 124093746Sjulian 1241149151Sjhb MY_LOCK_ASSERT(sc); 1242147256Sbrooks ifp = sc->my_ifp; 124393746Sjulian ifp->if_timer = 0; 124493746Sjulian if (sc->my_cdata.my_tx_head == NULL) { 1245148887Srwatson ifp->if_drv_flags &= ~IFF_DRV_OACTIVE; 124693746Sjulian sc->my_cdata.my_tx_tail = NULL; 124793746Sjulian if (sc->my_want_auto) 124893746Sjulian my_autoneg_mii(sc, MY_FLAG_SCHEDDELAY, 1); 124993746Sjulian } else { 125093746Sjulian if (MY_TXOWN(sc->my_cdata.my_tx_head) == MY_UNSENT) { 125193746Sjulian MY_TXOWN(sc->my_cdata.my_tx_head) = MY_OWNByNIC; 125293746Sjulian ifp->if_timer = 5; 125393746Sjulian CSR_WRITE_4(sc, MY_TXPDR, 0xFFFFFFFF); 125493746Sjulian } 125593746Sjulian } 125693746Sjulian return; 125793746Sjulian} 125893746Sjulian 125993746Sjulianstatic void 126093746Sjulianmy_intr(void *arg) 126193746Sjulian{ 126293746Sjulian struct my_softc *sc; 126393746Sjulian struct ifnet *ifp; 126493746Sjulian u_int32_t status; 126593746Sjulian 126693746Sjulian sc = arg; 126793746Sjulian MY_LOCK(sc); 1268147256Sbrooks ifp = sc->my_ifp; 126993746Sjulian if (!(ifp->if_flags & IFF_UP)) { 127093746Sjulian MY_UNLOCK(sc); 127193746Sjulian return; 127293746Sjulian } 127393746Sjulian /* Disable interrupts. */ 127493746Sjulian CSR_WRITE_4(sc, MY_IMR, 0x00000000); 127593746Sjulian 127693746Sjulian for (;;) { 127793746Sjulian status = CSR_READ_4(sc, MY_ISR); 127893746Sjulian status &= MY_INTRS; 127993746Sjulian if (status) 128093746Sjulian CSR_WRITE_4(sc, MY_ISR, status); 128193746Sjulian else 128293746Sjulian break; 128393746Sjulian 128493746Sjulian if (status & MY_RI) /* receive interrupt */ 128593746Sjulian my_rxeof(sc); 128693746Sjulian 128793746Sjulian if ((status & MY_RBU) || (status & MY_RxErr)) { 128893746Sjulian /* rx buffer unavailable or rx error */ 128993746Sjulian ifp->if_ierrors++; 129093746Sjulian#ifdef foo 129193746Sjulian my_stop(sc); 129293746Sjulian my_reset(sc); 1293149151Sjhb my_init_locked(sc); 129493746Sjulian#endif 129593746Sjulian } 129693746Sjulian if (status & MY_TI) /* tx interrupt */ 129793746Sjulian my_txeof(sc); 129893746Sjulian if (status & MY_ETI) /* tx early interrupt */ 129993746Sjulian my_txeof(sc); 130093746Sjulian if (status & MY_TBU) /* tx buffer unavailable */ 130193746Sjulian my_txeoc(sc); 130294863Sjulian 130394863Sjulian#if 0 /* 90/1/18 delete */ 130494863Sjulian if (status & MY_FBE) { 130594863Sjulian my_reset(sc); 1306149151Sjhb my_init_locked(sc); 130794863Sjulian } 130894863Sjulian#endif 130994863Sjulian 131093746Sjulian } 131193746Sjulian 131293746Sjulian /* Re-enable interrupts. */ 131393746Sjulian CSR_WRITE_4(sc, MY_IMR, MY_INTRS); 1314159291Sbrueffer if (!IFQ_DRV_IS_EMPTY(&ifp->if_snd)) 1315149151Sjhb my_start_locked(ifp); 131693746Sjulian MY_UNLOCK(sc); 131793746Sjulian return; 131893746Sjulian} 131993746Sjulian 132093746Sjulian/* 132193746Sjulian * Encapsulate an mbuf chain in a descriptor by coupling the mbuf data 132293746Sjulian * pointers to the fragment pointers. 132393746Sjulian */ 132493746Sjulianstatic int 132593746Sjulianmy_encap(struct my_softc * sc, struct my_chain * c, struct mbuf * m_head) 132693746Sjulian{ 132793746Sjulian struct my_desc *f = NULL; 132893746Sjulian int total_len; 132993746Sjulian struct mbuf *m, *m_new = NULL; 133093746Sjulian 1331149151Sjhb MY_LOCK_ASSERT(sc); 133293746Sjulian /* calculate the total tx pkt length */ 133393746Sjulian total_len = 0; 133493746Sjulian for (m = m_head; m != NULL; m = m->m_next) 133593746Sjulian total_len += m->m_len; 133693746Sjulian /* 133793746Sjulian * Start packing the mbufs in this chain into the fragment pointers. 133893746Sjulian * Stop when we run out of fragments or hit the end of the mbuf 133993746Sjulian * chain. 134093746Sjulian */ 134193746Sjulian m = m_head; 1342111119Simp MGETHDR(m_new, M_DONTWAIT, MT_DATA); 134393746Sjulian if (m_new == NULL) { 1344162321Sglebius device_printf(sc->my_dev, "no memory for tx list"); 134593746Sjulian return (1); 134693746Sjulian } 134793746Sjulian if (m_head->m_pkthdr.len > MHLEN) { 1348111119Simp MCLGET(m_new, M_DONTWAIT); 134993746Sjulian if (!(m_new->m_flags & M_EXT)) { 135093746Sjulian m_freem(m_new); 1351162321Sglebius device_printf(sc->my_dev, "no memory for tx list"); 135293746Sjulian return (1); 135393746Sjulian } 135493746Sjulian } 135593746Sjulian m_copydata(m_head, 0, m_head->m_pkthdr.len, mtod(m_new, caddr_t)); 135693746Sjulian m_new->m_pkthdr.len = m_new->m_len = m_head->m_pkthdr.len; 135793746Sjulian m_freem(m_head); 135893746Sjulian m_head = m_new; 135993746Sjulian f = &c->my_ptr->my_frag[0]; 136093746Sjulian f->my_status = 0; 136193746Sjulian f->my_data = vtophys(mtod(m_new, caddr_t)); 136293746Sjulian total_len = m_new->m_len; 136393746Sjulian f->my_ctl = MY_TXFD | MY_TXLD | MY_CRCEnable | MY_PADEnable; 136493746Sjulian f->my_ctl |= total_len << MY_PKTShift; /* pkt size */ 136593746Sjulian f->my_ctl |= total_len; /* buffer size */ 136694904Sjulian /* 89/12/29 add, for mtd891 *//* [ 89? ] */ 136793746Sjulian if (sc->my_info->my_did == MTD891ID) 136893746Sjulian f->my_ctl |= MY_ETIControl | MY_RetryTxLC; 136993746Sjulian c->my_mbuf = m_head; 137093746Sjulian c->my_lastdesc = 0; 137193746Sjulian MY_TXNEXT(c) = vtophys(&c->my_nextdesc->my_ptr->my_frag[0]); 137293746Sjulian return (0); 137393746Sjulian} 137493746Sjulian 137593746Sjulian/* 137693746Sjulian * Main transmit routine. To avoid having to do mbuf copies, we put pointers 137793746Sjulian * to the mbuf data regions directly in the transmit lists. We also save a 137893746Sjulian * copy of the pointers since the transmit list fragment pointers are 137993746Sjulian * physical addresses. 138093746Sjulian */ 138193746Sjulianstatic void 138293746Sjulianmy_start(struct ifnet * ifp) 138393746Sjulian{ 138493746Sjulian struct my_softc *sc; 1385149151Sjhb 1386149151Sjhb sc = ifp->if_softc; 1387149151Sjhb MY_LOCK(sc); 1388149151Sjhb my_start_locked(ifp); 1389149151Sjhb MY_UNLOCK(sc); 1390149151Sjhb} 1391149151Sjhb 1392149151Sjhbstatic void 1393149151Sjhbmy_start_locked(struct ifnet * ifp) 1394149151Sjhb{ 1395149151Sjhb struct my_softc *sc; 139693746Sjulian struct mbuf *m_head = NULL; 139793746Sjulian struct my_chain *cur_tx = NULL, *start_tx; 139893746Sjulian 139993746Sjulian sc = ifp->if_softc; 1400149151Sjhb MY_LOCK_ASSERT(sc); 140193746Sjulian if (sc->my_autoneg) { 140293746Sjulian sc->my_tx_pend = 1; 140393746Sjulian return; 140493746Sjulian } 140593746Sjulian /* 140693746Sjulian * Check for an available queue slot. If there are none, punt. 140793746Sjulian */ 140893746Sjulian if (sc->my_cdata.my_tx_free->my_mbuf != NULL) { 1409148887Srwatson ifp->if_drv_flags |= IFF_DRV_OACTIVE; 141093746Sjulian return; 141193746Sjulian } 141293746Sjulian start_tx = sc->my_cdata.my_tx_free; 141393746Sjulian while (sc->my_cdata.my_tx_free->my_mbuf == NULL) { 1414159291Sbrueffer IFQ_DRV_DEQUEUE(&ifp->if_snd, m_head); 141593746Sjulian if (m_head == NULL) 141693746Sjulian break; 141793746Sjulian 141893746Sjulian /* Pick a descriptor off the free list. */ 141993746Sjulian cur_tx = sc->my_cdata.my_tx_free; 142093746Sjulian sc->my_cdata.my_tx_free = cur_tx->my_nextdesc; 142193746Sjulian 142293746Sjulian /* Pack the data into the descriptor. */ 142393746Sjulian my_encap(sc, cur_tx, m_head); 142493746Sjulian 142593746Sjulian if (cur_tx != start_tx) 142693746Sjulian MY_TXOWN(cur_tx) = MY_OWNByNIC; 142793746Sjulian#if NBPFILTER > 0 142893746Sjulian /* 142993746Sjulian * If there's a BPF listener, bounce a copy of this frame to 143093746Sjulian * him. 143193746Sjulian */ 1432106937Ssam BPF_MTAP(ifp, cur_tx->my_mbuf); 143393746Sjulian#endif 143493746Sjulian } 143593746Sjulian /* 143693746Sjulian * If there are no packets queued, bail. 143793746Sjulian */ 143893746Sjulian if (cur_tx == NULL) { 143993746Sjulian return; 144093746Sjulian } 144193746Sjulian /* 144293746Sjulian * Place the request for the upload interrupt in the last descriptor 144393746Sjulian * in the chain. This way, if we're chaining several packets at once, 1444172568Skevlo * we'll only get an interrupt once for the whole chain rather than 144593746Sjulian * once for each packet. 144693746Sjulian */ 144793746Sjulian MY_TXCTL(cur_tx) |= MY_TXIC; 144893746Sjulian cur_tx->my_ptr->my_frag[0].my_ctl |= MY_TXIC; 144993746Sjulian sc->my_cdata.my_tx_tail = cur_tx; 145093746Sjulian if (sc->my_cdata.my_tx_head == NULL) 145193746Sjulian sc->my_cdata.my_tx_head = start_tx; 145293746Sjulian MY_TXOWN(start_tx) = MY_OWNByNIC; 145393746Sjulian CSR_WRITE_4(sc, MY_TXPDR, 0xFFFFFFFF); /* tx polling demand */ 145493746Sjulian 145593746Sjulian /* 145693746Sjulian * Set a timeout in case the chip goes out to lunch. 145793746Sjulian */ 145893746Sjulian ifp->if_timer = 5; 145993746Sjulian return; 146093746Sjulian} 146193746Sjulian 146293746Sjulianstatic void 146393746Sjulianmy_init(void *xsc) 146493746Sjulian{ 146593746Sjulian struct my_softc *sc = xsc; 1466149151Sjhb 1467149151Sjhb MY_LOCK(sc); 1468149151Sjhb my_init_locked(sc); 1469149151Sjhb MY_UNLOCK(sc); 1470149151Sjhb} 1471149151Sjhb 1472149151Sjhbstatic void 1473149151Sjhbmy_init_locked(struct my_softc *sc) 1474149151Sjhb{ 1475147256Sbrooks struct ifnet *ifp = sc->my_ifp; 147693746Sjulian u_int16_t phy_bmcr = 0; 147793746Sjulian 1478149151Sjhb MY_LOCK_ASSERT(sc); 147993746Sjulian if (sc->my_autoneg) { 148093746Sjulian return; 148193746Sjulian } 148293746Sjulian if (sc->my_pinfo != NULL) 148393746Sjulian phy_bmcr = my_phy_readreg(sc, PHY_BMCR); 148493746Sjulian /* 148593746Sjulian * Cancel pending I/O and free all RX/TX buffers. 148693746Sjulian */ 148793746Sjulian my_stop(sc); 148893746Sjulian my_reset(sc); 148993746Sjulian 149093746Sjulian /* 149193746Sjulian * Set cache alignment and burst length. 149293746Sjulian */ 149394863Sjulian#if 0 /* 89/9/1 modify, */ 149494863Sjulian CSR_WRITE_4(sc, MY_BCR, MY_RPBLE512); 149594863Sjulian CSR_WRITE_4(sc, MY_TCRRCR, MY_TFTSF); 149694863Sjulian#endif 149793746Sjulian CSR_WRITE_4(sc, MY_BCR, MY_PBL8); 149893746Sjulian CSR_WRITE_4(sc, MY_TCRRCR, MY_TFTSF | MY_RBLEN | MY_RPBLE512); 149993746Sjulian /* 150093746Sjulian * 89/12/29 add, for mtd891, 150193746Sjulian */ 150293746Sjulian if (sc->my_info->my_did == MTD891ID) { 150393746Sjulian MY_SETBIT(sc, MY_BCR, MY_PROG); 150493746Sjulian MY_SETBIT(sc, MY_TCRRCR, MY_Enhanced); 150593746Sjulian } 150693746Sjulian my_setcfg(sc, phy_bmcr); 150793746Sjulian /* Init circular RX list. */ 150893746Sjulian if (my_list_rx_init(sc) == ENOBUFS) { 1509162321Sglebius device_printf(sc->my_dev, "init failed: no memory for rx buffers\n"); 151093746Sjulian my_stop(sc); 151193746Sjulian return; 151293746Sjulian } 151393746Sjulian /* Init TX descriptors. */ 151493746Sjulian my_list_tx_init(sc); 151593746Sjulian 151693746Sjulian /* If we want promiscuous mode, set the allframes bit. */ 151793746Sjulian if (ifp->if_flags & IFF_PROMISC) 151893746Sjulian MY_SETBIT(sc, MY_TCRRCR, MY_PROM); 151993746Sjulian else 152093746Sjulian MY_CLRBIT(sc, MY_TCRRCR, MY_PROM); 152193746Sjulian 152293746Sjulian /* 152393746Sjulian * Set capture broadcast bit to capture broadcast frames. 152493746Sjulian */ 152593746Sjulian if (ifp->if_flags & IFF_BROADCAST) 152693746Sjulian MY_SETBIT(sc, MY_TCRRCR, MY_AB); 152793746Sjulian else 152893746Sjulian MY_CLRBIT(sc, MY_TCRRCR, MY_AB); 152993746Sjulian 153093746Sjulian /* 153193746Sjulian * Program the multicast filter, if necessary. 153293746Sjulian */ 153393746Sjulian my_setmulti(sc); 153493746Sjulian 153593746Sjulian /* 153693746Sjulian * Load the address of the RX list. 153793746Sjulian */ 153893746Sjulian MY_CLRBIT(sc, MY_TCRRCR, MY_RE); 153993746Sjulian CSR_WRITE_4(sc, MY_RXLBA, vtophys(&sc->my_ldata->my_rx_list[0])); 154093746Sjulian 154193746Sjulian /* 154293746Sjulian * Enable interrupts. 154393746Sjulian */ 154493746Sjulian CSR_WRITE_4(sc, MY_IMR, MY_INTRS); 154593746Sjulian CSR_WRITE_4(sc, MY_ISR, 0xFFFFFFFF); 154693746Sjulian 154793746Sjulian /* Enable receiver and transmitter. */ 154893746Sjulian MY_SETBIT(sc, MY_TCRRCR, MY_RE); 154993746Sjulian MY_CLRBIT(sc, MY_TCRRCR, MY_TE); 155093746Sjulian CSR_WRITE_4(sc, MY_TXLBA, vtophys(&sc->my_ldata->my_tx_list[0])); 155193746Sjulian MY_SETBIT(sc, MY_TCRRCR, MY_TE); 155293746Sjulian 155393746Sjulian /* Restore state of BMCR */ 155493746Sjulian if (sc->my_pinfo != NULL) 155593746Sjulian my_phy_writereg(sc, PHY_BMCR, phy_bmcr); 1556148887Srwatson ifp->if_drv_flags |= IFF_DRV_RUNNING; 1557148887Srwatson ifp->if_drv_flags &= ~IFF_DRV_OACTIVE; 155893746Sjulian return; 155993746Sjulian} 156093746Sjulian 156193746Sjulian/* 156293746Sjulian * Set media options. 156393746Sjulian */ 156493746Sjulian 156593746Sjulianstatic int 156693746Sjulianmy_ifmedia_upd(struct ifnet * ifp) 156793746Sjulian{ 156893746Sjulian struct my_softc *sc; 156993746Sjulian struct ifmedia *ifm; 157093746Sjulian 157193746Sjulian sc = ifp->if_softc; 157293746Sjulian MY_LOCK(sc); 157393746Sjulian ifm = &sc->ifmedia; 157493746Sjulian if (IFM_TYPE(ifm->ifm_media) != IFM_ETHER) { 157593746Sjulian MY_UNLOCK(sc); 157693746Sjulian return (EINVAL); 157793746Sjulian } 157893746Sjulian if (IFM_SUBTYPE(ifm->ifm_media) == IFM_AUTO) 157993746Sjulian my_autoneg_mii(sc, MY_FLAG_SCHEDDELAY, 1); 158093746Sjulian else 158193746Sjulian my_setmode_mii(sc, ifm->ifm_media); 158293746Sjulian MY_UNLOCK(sc); 158393746Sjulian return (0); 158493746Sjulian} 158593746Sjulian 158693746Sjulian/* 158793746Sjulian * Report current media status. 158893746Sjulian */ 158993746Sjulian 159093746Sjulianstatic void 159193746Sjulianmy_ifmedia_sts(struct ifnet * ifp, struct ifmediareq * ifmr) 159293746Sjulian{ 159393746Sjulian struct my_softc *sc; 159493746Sjulian u_int16_t advert = 0, ability = 0; 159593746Sjulian 159693746Sjulian sc = ifp->if_softc; 159793746Sjulian MY_LOCK(sc); 159893746Sjulian ifmr->ifm_active = IFM_ETHER; 159993746Sjulian if (!(my_phy_readreg(sc, PHY_BMCR) & PHY_BMCR_AUTONEGENBL)) { 160094863Sjulian#if 0 /* this version did not support 1000M, */ 160194863Sjulian if (my_phy_readreg(sc, PHY_BMCR) & PHY_BMCR_1000) 160294863Sjulian ifmr->ifm_active = IFM_ETHER | IFM_1000TX; 160394863Sjulian#endif 160493746Sjulian if (my_phy_readreg(sc, PHY_BMCR) & PHY_BMCR_SPEEDSEL) 160593746Sjulian ifmr->ifm_active = IFM_ETHER | IFM_100_TX; 160693746Sjulian else 160793746Sjulian ifmr->ifm_active = IFM_ETHER | IFM_10_T; 160893746Sjulian if (my_phy_readreg(sc, PHY_BMCR) & PHY_BMCR_DUPLEX) 160993746Sjulian ifmr->ifm_active |= IFM_FDX; 161093746Sjulian else 161193746Sjulian ifmr->ifm_active |= IFM_HDX; 161293746Sjulian 161393746Sjulian MY_UNLOCK(sc); 161493746Sjulian return; 161593746Sjulian } 161693746Sjulian ability = my_phy_readreg(sc, PHY_LPAR); 161793746Sjulian advert = my_phy_readreg(sc, PHY_ANAR); 161893746Sjulian 161994863Sjulian#if 0 /* this version did not support 1000M, */ 162093746Sjulian if (sc->my_pinfo->my_vid = MarvellPHYID0) { 162193746Sjulian ability2 = my_phy_readreg(sc, PHY_1000SR); 162293746Sjulian if (ability2 & PHY_1000SR_1000BTXFULL) { 162393746Sjulian advert = 0; 162493746Sjulian ability = 0; 162595673Sphk ifmr->ifm_active = IFM_ETHER|IFM_1000_T|IFM_FDX; 162693746Sjulian } else if (ability & PHY_1000SR_1000BTXHALF) { 162793746Sjulian advert = 0; 162893746Sjulian ability = 0; 162995673Sphk ifmr->ifm_active = IFM_ETHER|IFM_1000_T|IFM_HDX; 163093746Sjulian } 163193746Sjulian } 163293746Sjulian#endif 163393746Sjulian if (advert & PHY_ANAR_100BT4 && ability & PHY_ANAR_100BT4) 163493746Sjulian ifmr->ifm_active = IFM_ETHER | IFM_100_T4; 163593746Sjulian else if (advert & PHY_ANAR_100BTXFULL && ability & PHY_ANAR_100BTXFULL) 163693746Sjulian ifmr->ifm_active = IFM_ETHER | IFM_100_TX | IFM_FDX; 163793746Sjulian else if (advert & PHY_ANAR_100BTXHALF && ability & PHY_ANAR_100BTXHALF) 163893746Sjulian ifmr->ifm_active = IFM_ETHER | IFM_100_TX | IFM_HDX; 163993746Sjulian else if (advert & PHY_ANAR_10BTFULL && ability & PHY_ANAR_10BTFULL) 164093746Sjulian ifmr->ifm_active = IFM_ETHER | IFM_10_T | IFM_FDX; 164193746Sjulian else if (advert & PHY_ANAR_10BTHALF && ability & PHY_ANAR_10BTHALF) 164293746Sjulian ifmr->ifm_active = IFM_ETHER | IFM_10_T | IFM_HDX; 164393746Sjulian MY_UNLOCK(sc); 164493746Sjulian return; 164593746Sjulian} 164693746Sjulian 164793746Sjulianstatic int 164893746Sjulianmy_ioctl(struct ifnet * ifp, u_long command, caddr_t data) 164993746Sjulian{ 165093746Sjulian struct my_softc *sc = ifp->if_softc; 165193746Sjulian struct ifreq *ifr = (struct ifreq *) data; 1652149151Sjhb int error; 165393746Sjulian 165493746Sjulian switch (command) { 165593746Sjulian case SIOCSIFFLAGS: 1656149151Sjhb MY_LOCK(sc); 165793746Sjulian if (ifp->if_flags & IFF_UP) 1658149151Sjhb my_init_locked(sc); 1659148887Srwatson else if (ifp->if_drv_flags & IFF_DRV_RUNNING) 166093746Sjulian my_stop(sc); 1661149151Sjhb MY_UNLOCK(sc); 166293746Sjulian error = 0; 166393746Sjulian break; 166493746Sjulian case SIOCADDMULTI: 166593746Sjulian case SIOCDELMULTI: 1666149151Sjhb MY_LOCK(sc); 166793746Sjulian my_setmulti(sc); 1668149151Sjhb MY_UNLOCK(sc); 166993746Sjulian error = 0; 167093746Sjulian break; 167193746Sjulian case SIOCGIFMEDIA: 167293746Sjulian case SIOCSIFMEDIA: 167393746Sjulian error = ifmedia_ioctl(ifp, ifr, &sc->ifmedia, command); 167493746Sjulian break; 167593746Sjulian default: 1676106937Ssam error = ether_ioctl(ifp, command, data); 167793746Sjulian break; 167893746Sjulian } 167993746Sjulian return (error); 168093746Sjulian} 168193746Sjulian 168293746Sjulianstatic void 168393746Sjulianmy_watchdog(struct ifnet * ifp) 168493746Sjulian{ 168593746Sjulian struct my_softc *sc; 168693746Sjulian 168793746Sjulian sc = ifp->if_softc; 168893746Sjulian MY_LOCK(sc); 168993746Sjulian if (sc->my_autoneg) { 169093746Sjulian my_autoneg_mii(sc, MY_FLAG_DELAYTIMEO, 1); 169193746Sjulian MY_UNLOCK(sc); 169293746Sjulian return; 169393746Sjulian } 169493746Sjulian ifp->if_oerrors++; 1695148945Sjhb if_printf(ifp, "watchdog timeout\n"); 169693746Sjulian if (!(my_phy_readreg(sc, PHY_BMSR) & PHY_BMSR_LINKSTAT)) 1697148945Sjhb if_printf(ifp, "no carrier - transceiver cable problem?\n"); 169893746Sjulian my_stop(sc); 169993746Sjulian my_reset(sc); 1700149151Sjhb my_init_locked(sc); 1701159291Sbrueffer if (!IFQ_DRV_IS_EMPTY(&ifp->if_snd)) 1702149151Sjhb my_start_locked(ifp); 1703190325Sjhb MY_UNLOCK(sc); 170493746Sjulian return; 170593746Sjulian} 170693746Sjulian 170793746Sjulian 170893746Sjulian/* 170993746Sjulian * Stop the adapter and free any mbufs allocated to the RX and TX lists. 171093746Sjulian */ 171193746Sjulianstatic void 171293746Sjulianmy_stop(struct my_softc * sc) 171393746Sjulian{ 171493746Sjulian register int i; 171593746Sjulian struct ifnet *ifp; 171693746Sjulian 1717149151Sjhb MY_LOCK_ASSERT(sc); 1718147256Sbrooks ifp = sc->my_ifp; 171993746Sjulian ifp->if_timer = 0; 172093746Sjulian 172193746Sjulian MY_CLRBIT(sc, MY_TCRRCR, (MY_RE | MY_TE)); 172293746Sjulian CSR_WRITE_4(sc, MY_IMR, 0x00000000); 172393746Sjulian CSR_WRITE_4(sc, MY_TXLBA, 0x00000000); 172493746Sjulian CSR_WRITE_4(sc, MY_RXLBA, 0x00000000); 172593746Sjulian 172693746Sjulian /* 172793746Sjulian * Free data in the RX lists. 172893746Sjulian */ 172993746Sjulian for (i = 0; i < MY_RX_LIST_CNT; i++) { 173093746Sjulian if (sc->my_cdata.my_rx_chain[i].my_mbuf != NULL) { 173193746Sjulian m_freem(sc->my_cdata.my_rx_chain[i].my_mbuf); 173293746Sjulian sc->my_cdata.my_rx_chain[i].my_mbuf = NULL; 173393746Sjulian } 173493746Sjulian } 173593746Sjulian bzero((char *)&sc->my_ldata->my_rx_list, 173693746Sjulian sizeof(sc->my_ldata->my_rx_list)); 173793746Sjulian /* 173893746Sjulian * Free the TX list buffers. 173993746Sjulian */ 174093746Sjulian for (i = 0; i < MY_TX_LIST_CNT; i++) { 174193746Sjulian if (sc->my_cdata.my_tx_chain[i].my_mbuf != NULL) { 174293746Sjulian m_freem(sc->my_cdata.my_tx_chain[i].my_mbuf); 174393746Sjulian sc->my_cdata.my_tx_chain[i].my_mbuf = NULL; 174493746Sjulian } 174593746Sjulian } 174693746Sjulian bzero((char *)&sc->my_ldata->my_tx_list, 174793746Sjulian sizeof(sc->my_ldata->my_tx_list)); 1748148887Srwatson ifp->if_drv_flags &= ~(IFF_DRV_RUNNING | IFF_DRV_OACTIVE); 174993746Sjulian return; 175093746Sjulian} 175193746Sjulian 175293746Sjulian/* 175393746Sjulian * Stop all chip I/O so that the kernel's probe routines don't get confused 175493746Sjulian * by errant DMAs when rebooting. 175593746Sjulian */ 1756188172Simpstatic int 175793746Sjulianmy_shutdown(device_t dev) 175893746Sjulian{ 175993746Sjulian struct my_softc *sc; 176093746Sjulian 176193746Sjulian sc = device_get_softc(dev); 1762149151Sjhb MY_LOCK(sc); 176393746Sjulian my_stop(sc); 1764149151Sjhb MY_UNLOCK(sc); 1765188172Simp return 0; 176693746Sjulian} 1767