if_my.c revision 148946
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 148946 2005-08-10 20:21:29Z jhb $"); 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/clock.h> /* for DELAY */ 6093746Sjulian#include <machine/bus.h> 6193746Sjulian#include <machine/resource.h> 6293746Sjulian#include <sys/bus.h> 6393746Sjulian#include <sys/rman.h> 6493746Sjulian 65119285Simp#include <dev/pci/pcireg.h> 66119285Simp#include <dev/pci/pcivar.h> 6793746Sjulian 6893746Sjulian#include <dev/mii/mii.h> 6993746Sjulian#include <dev/mii/miivar.h> 7093746Sjulian 7193746Sjulian#include "miibus_if.h" 7293746Sjulian 7393746Sjulian/* 7493746Sjulian * #define MY_USEIOSPACE 7593746Sjulian */ 7693746Sjulian 7793746Sjulianstatic int MY_USEIOSPACE = 1; 7893746Sjulian 7993746Sjulian#if (MY_USEIOSPACE) 8094904Sjulian#define MY_RES SYS_RES_IOPORT 8194904Sjulian#define MY_RID MY_PCI_LOIO 8293746Sjulian#else 8394904Sjulian#define MY_RES SYS_RES_MEMORY 8494904Sjulian#define MY_RID MY_PCI_LOMEM 8593746Sjulian#endif 8693746Sjulian 8793746Sjulian 8893746Sjulian#include <dev/my/if_myreg.h> 8993746Sjulian 9093746Sjulian#ifndef lint 9193746Sjulianstatic const char rcsid[] = 92119285Simp"$Id: if_my.c,v 1.16 2003/04/15 06:37:25 mdodd Exp $"; 9393746Sjulian#endif 9493746Sjulian 9593746Sjulian/* 9693746Sjulian * Various supported device vendors/types and their names. 9793746Sjulian */ 9893746Sjulianstruct my_type *my_info_tmp; 9993746Sjulianstatic struct my_type my_devs[] = { 10093746Sjulian {MYSONVENDORID, MTD800ID, "Myson MTD80X Based Fast Ethernet Card"}, 10193746Sjulian {MYSONVENDORID, MTD803ID, "Myson MTD80X Based Fast Ethernet Card"}, 10293746Sjulian {MYSONVENDORID, MTD891ID, "Myson MTD89X Based Giga Ethernet Card"}, 10393746Sjulian {0, 0, NULL} 10493746Sjulian}; 10593746Sjulian 10693746Sjulian/* 10793746Sjulian * Various supported PHY vendors/types and their names. Note that this driver 10893746Sjulian * will work with pretty much any MII-compliant PHY, so failure to positively 10993746Sjulian * identify the chip is not a fatal error. 11093746Sjulian */ 11193746Sjulianstatic struct my_type my_phys[] = { 11293746Sjulian {MysonPHYID0, MysonPHYID0, "<MYSON MTD981>"}, 11393746Sjulian {SeeqPHYID0, SeeqPHYID0, "<SEEQ 80225>"}, 11493746Sjulian {AhdocPHYID0, AhdocPHYID0, "<AHDOC 101>"}, 11593746Sjulian {MarvellPHYID0, MarvellPHYID0, "<MARVELL 88E1000>"}, 11693746Sjulian {LevelOnePHYID0, LevelOnePHYID0, "<LevelOne LXT1000>"}, 11793746Sjulian {0, 0, "<MII-compliant physical interface>"} 11893746Sjulian}; 11993746Sjulian 12093746Sjulianstatic int my_probe(device_t); 12193746Sjulianstatic int my_attach(device_t); 12293746Sjulianstatic int my_detach(device_t); 12393746Sjulianstatic int my_newbuf(struct my_softc *, struct my_chain_onefrag *); 12493746Sjulianstatic int my_encap(struct my_softc *, struct my_chain *, struct mbuf *); 12593746Sjulianstatic void my_rxeof(struct my_softc *); 12693746Sjulianstatic void my_txeof(struct my_softc *); 12793746Sjulianstatic void my_txeoc(struct my_softc *); 12893746Sjulianstatic void my_intr(void *); 12993746Sjulianstatic void my_start(struct ifnet *); 13093746Sjulianstatic int my_ioctl(struct ifnet *, u_long, caddr_t); 13193746Sjulianstatic void my_init(void *); 13293746Sjulianstatic void my_stop(struct my_softc *); 13393746Sjulianstatic void my_watchdog(struct ifnet *); 13493746Sjulianstatic void my_shutdown(device_t); 13593746Sjulianstatic int my_ifmedia_upd(struct ifnet *); 13693746Sjulianstatic void my_ifmedia_sts(struct ifnet *, struct ifmediareq *); 13793746Sjulianstatic u_int16_t my_phy_readreg(struct my_softc *, int); 13893746Sjulianstatic void my_phy_writereg(struct my_softc *, int, int); 13993746Sjulianstatic void my_autoneg_xmit(struct my_softc *); 14093746Sjulianstatic void my_autoneg_mii(struct my_softc *, int, int); 14193746Sjulianstatic void my_setmode_mii(struct my_softc *, int); 14293746Sjulianstatic void my_getmode_mii(struct my_softc *); 14393746Sjulianstatic void my_setcfg(struct my_softc *, int); 14493746Sjulianstatic void my_setmulti(struct my_softc *); 14593746Sjulianstatic void my_reset(struct my_softc *); 14693746Sjulianstatic int my_list_rx_init(struct my_softc *); 14793746Sjulianstatic int my_list_tx_init(struct my_softc *); 14893746Sjulianstatic long my_send_cmd_to_phy(struct my_softc *, int, int); 14993746Sjulian 150106696Salfred#define MY_SETBIT(sc, reg, x) CSR_WRITE_4(sc, reg, CSR_READ_4(sc, reg) | (x)) 151106696Salfred#define MY_CLRBIT(sc, reg, x) CSR_WRITE_4(sc, reg, CSR_READ_4(sc, reg) & ~(x)) 15293746Sjulian 15393746Sjulianstatic device_method_t my_methods[] = { 15493746Sjulian /* Device interface */ 15593746Sjulian DEVMETHOD(device_probe, my_probe), 15693746Sjulian DEVMETHOD(device_attach, my_attach), 15793746Sjulian DEVMETHOD(device_detach, my_detach), 15893746Sjulian DEVMETHOD(device_shutdown, my_shutdown), 15993746Sjulian 16093746Sjulian {0, 0} 16193746Sjulian}; 16293746Sjulian 16393746Sjulianstatic driver_t my_driver = { 16493746Sjulian "my", 16593746Sjulian my_methods, 16693746Sjulian sizeof(struct my_softc) 16793746Sjulian}; 16893746Sjulian 16993746Sjulianstatic devclass_t my_devclass; 17093746Sjulian 171113506SmdoddDRIVER_MODULE(my, pci, my_driver, my_devclass, 0, 0); 172113506SmdoddMODULE_DEPEND(my, pci, 1, 1, 1); 173113506SmdoddMODULE_DEPEND(my, ether, 1, 1, 1); 17493746Sjulian 17593746Sjulianstatic long 17693746Sjulianmy_send_cmd_to_phy(struct my_softc * sc, int opcode, int regad) 17793746Sjulian{ 17893746Sjulian long miir; 17993746Sjulian int i; 18093746Sjulian int mask, data; 18193746Sjulian 18293746Sjulian MY_LOCK(sc); 18393746Sjulian 18493746Sjulian /* enable MII output */ 18593746Sjulian miir = CSR_READ_4(sc, MY_MANAGEMENT); 18693746Sjulian miir &= 0xfffffff0; 18793746Sjulian 18893746Sjulian miir |= MY_MASK_MIIR_MII_WRITE + MY_MASK_MIIR_MII_MDO; 18993746Sjulian 19093746Sjulian /* send 32 1's preamble */ 19193746Sjulian for (i = 0; i < 32; i++) { 19293746Sjulian /* low MDC; MDO is already high (miir) */ 19393746Sjulian miir &= ~MY_MASK_MIIR_MII_MDC; 19493746Sjulian CSR_WRITE_4(sc, MY_MANAGEMENT, miir); 19593746Sjulian 19693746Sjulian /* high MDC */ 19793746Sjulian miir |= MY_MASK_MIIR_MII_MDC; 19893746Sjulian CSR_WRITE_4(sc, MY_MANAGEMENT, miir); 19993746Sjulian } 20093746Sjulian 20193746Sjulian /* calculate ST+OP+PHYAD+REGAD+TA */ 20293746Sjulian data = opcode | (sc->my_phy_addr << 7) | (regad << 2); 20393746Sjulian 20493746Sjulian /* sent out */ 20593746Sjulian mask = 0x8000; 20693746Sjulian while (mask) { 20793746Sjulian /* low MDC, prepare MDO */ 20893746Sjulian miir &= ~(MY_MASK_MIIR_MII_MDC + MY_MASK_MIIR_MII_MDO); 20993746Sjulian if (mask & data) 21093746Sjulian miir |= MY_MASK_MIIR_MII_MDO; 21193746Sjulian 21293746Sjulian CSR_WRITE_4(sc, MY_MANAGEMENT, miir); 21393746Sjulian /* high MDC */ 21493746Sjulian miir |= MY_MASK_MIIR_MII_MDC; 21593746Sjulian CSR_WRITE_4(sc, MY_MANAGEMENT, miir); 21693746Sjulian DELAY(30); 21793746Sjulian 21893746Sjulian /* next */ 21993746Sjulian mask >>= 1; 22093746Sjulian if (mask == 0x2 && opcode == MY_OP_READ) 22193746Sjulian miir &= ~MY_MASK_MIIR_MII_WRITE; 22293746Sjulian } 22393746Sjulian 22493746Sjulian MY_UNLOCK(sc); 22593746Sjulian return miir; 22693746Sjulian} 22793746Sjulian 22893746Sjulian 229148945Sjhbstatic u_int16_t 23093746Sjulianmy_phy_readreg(struct my_softc * sc, int reg) 23193746Sjulian{ 23293746Sjulian long miir; 23393746Sjulian int mask, data; 23493746Sjulian 23593746Sjulian MY_LOCK(sc); 23693746Sjulian 23793746Sjulian if (sc->my_info->my_did == MTD803ID) 23893746Sjulian data = CSR_READ_2(sc, MY_PHYBASE + reg * 2); 23993746Sjulian else { 24093746Sjulian miir = my_send_cmd_to_phy(sc, MY_OP_READ, reg); 24193746Sjulian 24293746Sjulian /* read data */ 24393746Sjulian mask = 0x8000; 24493746Sjulian data = 0; 24593746Sjulian while (mask) { 24693746Sjulian /* low MDC */ 24793746Sjulian miir &= ~MY_MASK_MIIR_MII_MDC; 24893746Sjulian CSR_WRITE_4(sc, MY_MANAGEMENT, miir); 24993746Sjulian 25093746Sjulian /* read MDI */ 25193746Sjulian miir = CSR_READ_4(sc, MY_MANAGEMENT); 25293746Sjulian if (miir & MY_MASK_MIIR_MII_MDI) 25393746Sjulian data |= mask; 25493746Sjulian 25593746Sjulian /* high MDC, and wait */ 25693746Sjulian miir |= MY_MASK_MIIR_MII_MDC; 25793746Sjulian CSR_WRITE_4(sc, MY_MANAGEMENT, miir); 25893746Sjulian DELAY(30); 25993746Sjulian 26093746Sjulian /* next */ 26193746Sjulian mask >>= 1; 26293746Sjulian } 26393746Sjulian 26493746Sjulian /* low MDC */ 26593746Sjulian miir &= ~MY_MASK_MIIR_MII_MDC; 26693746Sjulian CSR_WRITE_4(sc, MY_MANAGEMENT, miir); 26793746Sjulian } 26893746Sjulian 26993746Sjulian MY_UNLOCK(sc); 27093746Sjulian return (u_int16_t) data; 27193746Sjulian} 27293746Sjulian 27393746Sjulian 27493746Sjulianstatic void 27593746Sjulianmy_phy_writereg(struct my_softc * sc, int reg, int data) 27693746Sjulian{ 27793746Sjulian long miir; 27893746Sjulian int mask; 27993746Sjulian 28093746Sjulian MY_LOCK(sc); 28193746Sjulian 28293746Sjulian if (sc->my_info->my_did == MTD803ID) 28393746Sjulian CSR_WRITE_2(sc, MY_PHYBASE + reg * 2, data); 28493746Sjulian else { 28593746Sjulian miir = my_send_cmd_to_phy(sc, MY_OP_WRITE, reg); 28693746Sjulian 28793746Sjulian /* write data */ 28893746Sjulian mask = 0x8000; 28993746Sjulian while (mask) { 29093746Sjulian /* low MDC, prepare MDO */ 29193746Sjulian miir &= ~(MY_MASK_MIIR_MII_MDC + MY_MASK_MIIR_MII_MDO); 29293746Sjulian if (mask & data) 29393746Sjulian miir |= MY_MASK_MIIR_MII_MDO; 29493746Sjulian CSR_WRITE_4(sc, MY_MANAGEMENT, miir); 29593746Sjulian DELAY(1); 29693746Sjulian 29793746Sjulian /* high MDC */ 29893746Sjulian miir |= MY_MASK_MIIR_MII_MDC; 29993746Sjulian CSR_WRITE_4(sc, MY_MANAGEMENT, miir); 30093746Sjulian DELAY(1); 30193746Sjulian 30293746Sjulian /* next */ 30393746Sjulian mask >>= 1; 30493746Sjulian } 30593746Sjulian 30693746Sjulian /* low MDC */ 30793746Sjulian miir &= ~MY_MASK_MIIR_MII_MDC; 30893746Sjulian CSR_WRITE_4(sc, MY_MANAGEMENT, miir); 30993746Sjulian } 31093746Sjulian MY_UNLOCK(sc); 31193746Sjulian return; 31293746Sjulian} 31393746Sjulian 31493746Sjulian 31593746Sjulian/* 31693746Sjulian * Program the 64-bit multicast hash filter. 31793746Sjulian */ 31893746Sjulianstatic void 31993746Sjulianmy_setmulti(struct my_softc * sc) 32093746Sjulian{ 32193746Sjulian struct ifnet *ifp; 32293746Sjulian int h = 0; 32393746Sjulian u_int32_t hashes[2] = {0, 0}; 32493746Sjulian struct ifmultiaddr *ifma; 32593746Sjulian u_int32_t rxfilt; 32693746Sjulian int mcnt = 0; 32793746Sjulian 32893746Sjulian MY_LOCK(sc); 32993746Sjulian 330147256Sbrooks ifp = sc->my_ifp; 33193746Sjulian 33293746Sjulian rxfilt = CSR_READ_4(sc, MY_TCRRCR); 33393746Sjulian 33493746Sjulian if (ifp->if_flags & IFF_ALLMULTI || ifp->if_flags & IFF_PROMISC) { 33593746Sjulian rxfilt |= MY_AM; 33693746Sjulian CSR_WRITE_4(sc, MY_TCRRCR, rxfilt); 33793746Sjulian CSR_WRITE_4(sc, MY_MAR0, 0xFFFFFFFF); 33893746Sjulian CSR_WRITE_4(sc, MY_MAR1, 0xFFFFFFFF); 33993746Sjulian 34093746Sjulian MY_UNLOCK(sc); 34193746Sjulian 34293746Sjulian return; 34393746Sjulian } 34493746Sjulian /* first, zot all the existing hash bits */ 34593746Sjulian CSR_WRITE_4(sc, MY_MAR0, 0); 34693746Sjulian CSR_WRITE_4(sc, MY_MAR1, 0); 34793746Sjulian 34893746Sjulian /* now program new ones */ 349148654Srwatson IF_ADDR_LOCK(ifp); 35093746Sjulian TAILQ_FOREACH(ifma, &ifp->if_multiaddrs, ifma_link) { 35193746Sjulian if (ifma->ifma_addr->sa_family != AF_LINK) 35293746Sjulian continue; 353130270Snaddy h = ~ether_crc32_be(LLADDR((struct sockaddr_dl *) 354130270Snaddy ifma->ifma_addr), ETHER_ADDR_LEN) >> 26; 35593746Sjulian if (h < 32) 35693746Sjulian hashes[0] |= (1 << h); 35793746Sjulian else 35893746Sjulian hashes[1] |= (1 << (h - 32)); 35993746Sjulian mcnt++; 36093746Sjulian } 361148654Srwatson IF_ADDR_UNLOCK(ifp); 36293746Sjulian 36393746Sjulian if (mcnt) 36493746Sjulian rxfilt |= MY_AM; 36593746Sjulian else 36693746Sjulian rxfilt &= ~MY_AM; 36793746Sjulian CSR_WRITE_4(sc, MY_MAR0, hashes[0]); 36893746Sjulian CSR_WRITE_4(sc, MY_MAR1, hashes[1]); 36993746Sjulian CSR_WRITE_4(sc, MY_TCRRCR, rxfilt); 37093746Sjulian MY_UNLOCK(sc); 37193746Sjulian return; 37293746Sjulian} 37393746Sjulian 37493746Sjulian/* 37593746Sjulian * Initiate an autonegotiation session. 37693746Sjulian */ 37793746Sjulianstatic void 37893746Sjulianmy_autoneg_xmit(struct my_softc * sc) 37993746Sjulian{ 38093746Sjulian u_int16_t phy_sts = 0; 38193746Sjulian 38293746Sjulian MY_LOCK(sc); 38393746Sjulian 38493746Sjulian my_phy_writereg(sc, PHY_BMCR, PHY_BMCR_RESET); 38593746Sjulian DELAY(500); 38693746Sjulian while (my_phy_readreg(sc, PHY_BMCR) & PHY_BMCR_RESET); 38793746Sjulian 38893746Sjulian phy_sts = my_phy_readreg(sc, PHY_BMCR); 38993746Sjulian phy_sts |= PHY_BMCR_AUTONEGENBL | PHY_BMCR_AUTONEGRSTR; 39093746Sjulian my_phy_writereg(sc, PHY_BMCR, phy_sts); 39193746Sjulian 39293746Sjulian MY_UNLOCK(sc); 39393746Sjulian return; 39493746Sjulian} 39593746Sjulian 39693746Sjulian 39793746Sjulian/* 39893746Sjulian * Invoke autonegotiation on a PHY. 39993746Sjulian */ 40093746Sjulianstatic void 40193746Sjulianmy_autoneg_mii(struct my_softc * sc, int flag, int verbose) 40293746Sjulian{ 40393746Sjulian u_int16_t phy_sts = 0, media, advert, ability; 40493746Sjulian u_int16_t ability2 = 0; 40593746Sjulian struct ifnet *ifp; 40693746Sjulian struct ifmedia *ifm; 40793746Sjulian 40893746Sjulian MY_LOCK(sc); 40993746Sjulian 41093746Sjulian ifm = &sc->ifmedia; 411147256Sbrooks ifp = sc->my_ifp; 41293746Sjulian 41393746Sjulian ifm->ifm_media = IFM_ETHER | IFM_AUTO; 41493746Sjulian 41593746Sjulian#ifndef FORCE_AUTONEG_TFOUR 41693746Sjulian /* 41793746Sjulian * First, see if autoneg is supported. If not, there's no point in 41893746Sjulian * continuing. 41993746Sjulian */ 42093746Sjulian phy_sts = my_phy_readreg(sc, PHY_BMSR); 42193746Sjulian if (!(phy_sts & PHY_BMSR_CANAUTONEG)) { 42293746Sjulian if (verbose) 423148945Sjhb if_printf(ifp, "autonegotiation not supported\n"); 42493746Sjulian ifm->ifm_media = IFM_ETHER | IFM_10_T | IFM_HDX; 42593746Sjulian MY_UNLOCK(sc); 42693746Sjulian return; 42793746Sjulian } 42893746Sjulian#endif 42993746Sjulian switch (flag) { 43093746Sjulian case MY_FLAG_FORCEDELAY: 43193746Sjulian /* 43293746Sjulian * XXX Never use this option anywhere but in the probe 43393746Sjulian * routine: making the kernel stop dead in its tracks for 43493746Sjulian * three whole seconds after we've gone multi-user is really 43593746Sjulian * bad manners. 43693746Sjulian */ 43793746Sjulian my_autoneg_xmit(sc); 43893746Sjulian DELAY(5000000); 43993746Sjulian break; 44093746Sjulian case MY_FLAG_SCHEDDELAY: 44193746Sjulian /* 44293746Sjulian * Wait for the transmitter to go idle before starting an 44393746Sjulian * autoneg session, otherwise my_start() may clobber our 44493746Sjulian * timeout, and we don't want to allow transmission during an 44593746Sjulian * autoneg session since that can screw it up. 44693746Sjulian */ 44793746Sjulian if (sc->my_cdata.my_tx_head != NULL) { 44893746Sjulian sc->my_want_auto = 1; 44993746Sjulian MY_UNLOCK(sc); 45093746Sjulian return; 45193746Sjulian } 45293746Sjulian my_autoneg_xmit(sc); 45393746Sjulian ifp->if_timer = 5; 45493746Sjulian sc->my_autoneg = 1; 45593746Sjulian sc->my_want_auto = 0; 45693746Sjulian MY_UNLOCK(sc); 45793746Sjulian return; 45893746Sjulian case MY_FLAG_DELAYTIMEO: 45993746Sjulian ifp->if_timer = 0; 46093746Sjulian sc->my_autoneg = 0; 46193746Sjulian break; 46293746Sjulian default: 463148945Sjhb if_printf(ifp, "invalid autoneg flag: %d\n", flag); 46493746Sjulian return; 46593746Sjulian } 46693746Sjulian 46793746Sjulian if (my_phy_readreg(sc, PHY_BMSR) & PHY_BMSR_AUTONEGCOMP) { 46893746Sjulian if (verbose) 469148945Sjhb if_printf(ifp, "autoneg complete, "); 47093746Sjulian phy_sts = my_phy_readreg(sc, PHY_BMSR); 47193746Sjulian } else { 47293746Sjulian if (verbose) 473148945Sjhb if_printf(ifp, "autoneg not complete, "); 47493746Sjulian } 47593746Sjulian 47693746Sjulian media = my_phy_readreg(sc, PHY_BMCR); 47793746Sjulian 47893746Sjulian /* Link is good. Report modes and set duplex mode. */ 47993746Sjulian if (my_phy_readreg(sc, PHY_BMSR) & PHY_BMSR_LINKSTAT) { 48093746Sjulian if (verbose) 481148945Sjhb if_printf(ifp, "link status good. "); 48293746Sjulian advert = my_phy_readreg(sc, PHY_ANAR); 48393746Sjulian ability = my_phy_readreg(sc, PHY_LPAR); 48493746Sjulian if ((sc->my_pinfo->my_vid == MarvellPHYID0) || 48593746Sjulian (sc->my_pinfo->my_vid == LevelOnePHYID0)) { 48693746Sjulian ability2 = my_phy_readreg(sc, PHY_1000SR); 48793746Sjulian if (ability2 & PHY_1000SR_1000BTXFULL) { 48893746Sjulian advert = 0; 48993746Sjulian ability = 0; 49093746Sjulian /* 49193746Sjulian * this version did not support 1000M, 49293746Sjulian * ifm->ifm_media = 49395673Sphk * IFM_ETHER|IFM_1000_T|IFM_FDX; 49493746Sjulian */ 49593746Sjulian ifm->ifm_media = 49693746Sjulian IFM_ETHER | IFM_100_TX | IFM_FDX; 49793746Sjulian media &= ~PHY_BMCR_SPEEDSEL; 49893746Sjulian media |= PHY_BMCR_1000; 49993746Sjulian media |= PHY_BMCR_DUPLEX; 50093746Sjulian printf("(full-duplex, 1000Mbps)\n"); 50193746Sjulian } else if (ability2 & PHY_1000SR_1000BTXHALF) { 50293746Sjulian advert = 0; 50393746Sjulian ability = 0; 50493746Sjulian /* 50593746Sjulian * this version did not support 1000M, 50695673Sphk * ifm->ifm_media = IFM_ETHER|IFM_1000_T; 50793746Sjulian */ 50893746Sjulian ifm->ifm_media = IFM_ETHER | IFM_100_TX; 50993746Sjulian media &= ~PHY_BMCR_SPEEDSEL; 51093746Sjulian media &= ~PHY_BMCR_DUPLEX; 51193746Sjulian media |= PHY_BMCR_1000; 51293746Sjulian printf("(half-duplex, 1000Mbps)\n"); 51393746Sjulian } 51493746Sjulian } 51593746Sjulian if (advert & PHY_ANAR_100BT4 && ability & PHY_ANAR_100BT4) { 51693746Sjulian ifm->ifm_media = IFM_ETHER | IFM_100_T4; 51793746Sjulian media |= PHY_BMCR_SPEEDSEL; 51893746Sjulian media &= ~PHY_BMCR_DUPLEX; 51993746Sjulian printf("(100baseT4)\n"); 52093746Sjulian } else if (advert & PHY_ANAR_100BTXFULL && 52193746Sjulian ability & PHY_ANAR_100BTXFULL) { 52293746Sjulian ifm->ifm_media = IFM_ETHER | IFM_100_TX | IFM_FDX; 52393746Sjulian media |= PHY_BMCR_SPEEDSEL; 52493746Sjulian media |= PHY_BMCR_DUPLEX; 52593746Sjulian printf("(full-duplex, 100Mbps)\n"); 52693746Sjulian } else if (advert & PHY_ANAR_100BTXHALF && 52793746Sjulian ability & PHY_ANAR_100BTXHALF) { 52893746Sjulian ifm->ifm_media = IFM_ETHER | IFM_100_TX | IFM_HDX; 52993746Sjulian media |= PHY_BMCR_SPEEDSEL; 53093746Sjulian media &= ~PHY_BMCR_DUPLEX; 53193746Sjulian printf("(half-duplex, 100Mbps)\n"); 53293746Sjulian } else if (advert & PHY_ANAR_10BTFULL && 53393746Sjulian ability & PHY_ANAR_10BTFULL) { 53493746Sjulian ifm->ifm_media = IFM_ETHER | IFM_10_T | IFM_FDX; 53593746Sjulian media &= ~PHY_BMCR_SPEEDSEL; 53693746Sjulian media |= PHY_BMCR_DUPLEX; 53793746Sjulian printf("(full-duplex, 10Mbps)\n"); 53893746Sjulian } else if (advert) { 53993746Sjulian ifm->ifm_media = IFM_ETHER | IFM_10_T | IFM_HDX; 54093746Sjulian media &= ~PHY_BMCR_SPEEDSEL; 54193746Sjulian media &= ~PHY_BMCR_DUPLEX; 54293746Sjulian printf("(half-duplex, 10Mbps)\n"); 54393746Sjulian } 54493746Sjulian media &= ~PHY_BMCR_AUTONEGENBL; 54593746Sjulian 54693746Sjulian /* Set ASIC's duplex mode to match the PHY. */ 54793746Sjulian my_phy_writereg(sc, PHY_BMCR, media); 54893746Sjulian my_setcfg(sc, media); 54993746Sjulian } else { 55093746Sjulian if (verbose) 551148945Sjhb if_printf(ifp, "no carrier\n"); 55293746Sjulian } 55393746Sjulian 55493746Sjulian my_init(sc); 55593746Sjulian if (sc->my_tx_pend) { 55693746Sjulian sc->my_autoneg = 0; 55793746Sjulian sc->my_tx_pend = 0; 55893746Sjulian my_start(ifp); 55993746Sjulian } 56093746Sjulian MY_UNLOCK(sc); 56193746Sjulian return; 56293746Sjulian} 56393746Sjulian 56493746Sjulian/* 56593746Sjulian * To get PHY ability. 56693746Sjulian */ 56793746Sjulianstatic void 56893746Sjulianmy_getmode_mii(struct my_softc * sc) 56993746Sjulian{ 57093746Sjulian u_int16_t bmsr; 57193746Sjulian struct ifnet *ifp; 57293746Sjulian 57393746Sjulian MY_LOCK(sc); 574147256Sbrooks ifp = sc->my_ifp; 57593746Sjulian bmsr = my_phy_readreg(sc, PHY_BMSR); 57693746Sjulian if (bootverbose) 577148945Sjhb if_printf(ifp, "PHY status word: %x\n", bmsr); 57893746Sjulian 57993746Sjulian /* fallback */ 58093746Sjulian sc->ifmedia.ifm_media = IFM_ETHER | IFM_10_T | IFM_HDX; 58193746Sjulian 58293746Sjulian if (bmsr & PHY_BMSR_10BTHALF) { 58393746Sjulian if (bootverbose) 584148945Sjhb if_printf(ifp, "10Mbps half-duplex mode supported\n"); 58593746Sjulian ifmedia_add(&sc->ifmedia, IFM_ETHER | IFM_10_T | IFM_HDX, 58693746Sjulian 0, NULL); 58793746Sjulian ifmedia_add(&sc->ifmedia, IFM_ETHER | IFM_10_T, 0, NULL); 58893746Sjulian } 58993746Sjulian if (bmsr & PHY_BMSR_10BTFULL) { 59093746Sjulian if (bootverbose) 591148945Sjhb if_printf(ifp, "10Mbps full-duplex mode supported\n"); 59293746Sjulian 59393746Sjulian ifmedia_add(&sc->ifmedia, IFM_ETHER | IFM_10_T | IFM_FDX, 59493746Sjulian 0, NULL); 59593746Sjulian sc->ifmedia.ifm_media = IFM_ETHER | IFM_10_T | IFM_FDX; 59693746Sjulian } 59793746Sjulian if (bmsr & PHY_BMSR_100BTXHALF) { 59893746Sjulian if (bootverbose) 599148945Sjhb if_printf(ifp, "100Mbps half-duplex mode supported\n"); 60093746Sjulian ifp->if_baudrate = 100000000; 60193746Sjulian ifmedia_add(&sc->ifmedia, IFM_ETHER | IFM_100_TX, 0, NULL); 60293746Sjulian ifmedia_add(&sc->ifmedia, IFM_ETHER | IFM_100_TX | IFM_HDX, 60393746Sjulian 0, NULL); 60493746Sjulian sc->ifmedia.ifm_media = IFM_ETHER | IFM_100_TX | IFM_HDX; 60593746Sjulian } 60693746Sjulian if (bmsr & PHY_BMSR_100BTXFULL) { 60793746Sjulian if (bootverbose) 608148945Sjhb if_printf(ifp, "100Mbps full-duplex mode supported\n"); 60993746Sjulian ifp->if_baudrate = 100000000; 61093746Sjulian ifmedia_add(&sc->ifmedia, IFM_ETHER | IFM_100_TX | IFM_FDX, 61193746Sjulian 0, NULL); 61293746Sjulian sc->ifmedia.ifm_media = IFM_ETHER | IFM_100_TX | IFM_FDX; 61393746Sjulian } 61493746Sjulian /* Some also support 100BaseT4. */ 61593746Sjulian if (bmsr & PHY_BMSR_100BT4) { 61693746Sjulian if (bootverbose) 617148945Sjhb if_printf(ifp, "100baseT4 mode supported\n"); 61893746Sjulian ifp->if_baudrate = 100000000; 61993746Sjulian ifmedia_add(&sc->ifmedia, IFM_ETHER | IFM_100_T4, 0, NULL); 62093746Sjulian sc->ifmedia.ifm_media = IFM_ETHER | IFM_100_T4; 62193746Sjulian#ifdef FORCE_AUTONEG_TFOUR 62293746Sjulian if (bootverbose) 623148945Sjhb if_printf(ifp, "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) 631148945Sjhb if_printf(ifp, "1000Mbps half-duplex mode supported\n"); 63293746Sjulian 63393746Sjulian ifp->if_baudrate = 1000000000; 63495673Sphk ifmedia_add(&sc->ifmedia, IFM_ETHER | IFM_1000_T, 0, NULL); 63595673Sphk ifmedia_add(&sc->ifmedia, IFM_ETHER | IFM_1000_T | IFM_HDX, 63693746Sjulian 0, NULL); 63793746Sjulian if (bootverbose) 638148945Sjhb if_printf(ifp, "1000Mbps full-duplex mode supported\n"); 63993746Sjulian ifp->if_baudrate = 1000000000; 64095673Sphk ifmedia_add(&sc->ifmedia, IFM_ETHER | IFM_1000_T | IFM_FDX, 64193746Sjulian 0, NULL); 64295673Sphk sc->ifmedia.ifm_media = IFM_ETHER | IFM_1000_T | IFM_FDX; 64393746Sjulian } 64493746Sjulian#endif 64593746Sjulian if (bmsr & PHY_BMSR_CANAUTONEG) { 64693746Sjulian if (bootverbose) 647148945Sjhb if_printf(ifp, "autoneg supported\n"); 64893746Sjulian ifmedia_add(&sc->ifmedia, IFM_ETHER | IFM_AUTO, 0, NULL); 64993746Sjulian sc->ifmedia.ifm_media = IFM_ETHER | IFM_AUTO; 65093746Sjulian } 65193746Sjulian MY_UNLOCK(sc); 65293746Sjulian return; 65393746Sjulian} 65493746Sjulian 65593746Sjulian/* 65693746Sjulian * Set speed and duplex mode. 65793746Sjulian */ 65893746Sjulianstatic void 65993746Sjulianmy_setmode_mii(struct my_softc * sc, int media) 66093746Sjulian{ 66193746Sjulian u_int16_t bmcr; 66293746Sjulian struct ifnet *ifp; 66393746Sjulian 66493746Sjulian MY_LOCK(sc); 665147256Sbrooks ifp = sc->my_ifp; 66693746Sjulian /* 66793746Sjulian * If an autoneg session is in progress, stop it. 66893746Sjulian */ 66993746Sjulian if (sc->my_autoneg) { 670148945Sjhb if_printf(ifp, "canceling autoneg session\n"); 67193746Sjulian ifp->if_timer = 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 } 676148945Sjhb if_printf(ifp, "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 MY_UNLOCK(sc); 71293746Sjulian return; 71393746Sjulian} 71493746Sjulian 71593746Sjulian/* 71693746Sjulian * The Myson manual states that in order to fiddle with the 'full-duplex' and 71793746Sjulian * '100Mbps' bits in the netconfig register, we first have to put the 71893746Sjulian * transmit and/or receive logic in the idle state. 71993746Sjulian */ 72093746Sjulianstatic void 72193746Sjulianmy_setcfg(struct my_softc * sc, int bmcr) 72293746Sjulian{ 72393746Sjulian int i, restart = 0; 72493746Sjulian 72593746Sjulian MY_LOCK(sc); 72693746Sjulian if (CSR_READ_4(sc, MY_TCRRCR) & (MY_TE | MY_RE)) { 72793746Sjulian restart = 1; 72893746Sjulian MY_CLRBIT(sc, MY_TCRRCR, (MY_TE | MY_RE)); 72993746Sjulian for (i = 0; i < MY_TIMEOUT; i++) { 73093746Sjulian DELAY(10); 73193746Sjulian if (!(CSR_READ_4(sc, MY_TCRRCR) & 73293746Sjulian (MY_TXRUN | MY_RXRUN))) 73393746Sjulian break; 73493746Sjulian } 73593746Sjulian if (i == MY_TIMEOUT) 736148945Sjhb if_printf(sc->my_ifp, 737148945Sjhb "failed to force tx and rx to idle \n"); 73893746Sjulian } 73993746Sjulian MY_CLRBIT(sc, MY_TCRRCR, MY_PS1000); 74093746Sjulian MY_CLRBIT(sc, MY_TCRRCR, MY_PS10); 74193746Sjulian if (bmcr & PHY_BMCR_1000) 74293746Sjulian MY_SETBIT(sc, MY_TCRRCR, MY_PS1000); 74393746Sjulian else if (!(bmcr & PHY_BMCR_SPEEDSEL)) 74493746Sjulian MY_SETBIT(sc, MY_TCRRCR, MY_PS10); 74593746Sjulian if (bmcr & PHY_BMCR_DUPLEX) 74693746Sjulian MY_SETBIT(sc, MY_TCRRCR, MY_FD); 74793746Sjulian else 74893746Sjulian MY_CLRBIT(sc, MY_TCRRCR, MY_FD); 74993746Sjulian if (restart) 75093746Sjulian MY_SETBIT(sc, MY_TCRRCR, MY_TE | MY_RE); 75193746Sjulian MY_UNLOCK(sc); 75293746Sjulian return; 75393746Sjulian} 75493746Sjulian 75593746Sjulianstatic void 75693746Sjulianmy_reset(struct my_softc * sc) 75793746Sjulian{ 75893746Sjulian register int i; 75993746Sjulian 76093746Sjulian MY_LOCK(sc); 76193746Sjulian MY_SETBIT(sc, MY_BCR, MY_SWR); 76293746Sjulian for (i = 0; i < MY_TIMEOUT; i++) { 76393746Sjulian DELAY(10); 76493746Sjulian if (!(CSR_READ_4(sc, MY_BCR) & MY_SWR)) 76593746Sjulian break; 76693746Sjulian } 76793746Sjulian if (i == MY_TIMEOUT) 768148945Sjhb if_printf(sc->my_ifp, "reset never completed!\n"); 76993746Sjulian 77093746Sjulian /* Wait a little while for the chip to get its brains in order. */ 77193746Sjulian DELAY(1000); 77293746Sjulian MY_UNLOCK(sc); 77393746Sjulian return; 77493746Sjulian} 77593746Sjulian 77693746Sjulian/* 77793746Sjulian * Probe for a Myson chip. Check the PCI vendor and device IDs against our 77893746Sjulian * list and return a device name if we find a match. 77993746Sjulian */ 78093746Sjulianstatic int 78193746Sjulianmy_probe(device_t dev) 78293746Sjulian{ 78393746Sjulian struct my_type *t; 78493746Sjulian 78593746Sjulian t = my_devs; 78693746Sjulian while (t->my_name != NULL) { 78793746Sjulian if ((pci_get_vendor(dev) == t->my_vid) && 78893746Sjulian (pci_get_device(dev) == t->my_did)) { 78993746Sjulian device_set_desc(dev, t->my_name); 79093746Sjulian my_info_tmp = t; 791143158Simp return (BUS_PROBE_DEFAULT); 79293746Sjulian } 79393746Sjulian t++; 79493746Sjulian } 79593746Sjulian return (ENXIO); 79693746Sjulian} 79793746Sjulian 79893746Sjulian/* 79993746Sjulian * Attach the interface. Allocate softc structures, do ifmedia setup and 80093746Sjulian * ethernet/BPF attach. 80193746Sjulian */ 80293746Sjulianstatic int 80393746Sjulianmy_attach(device_t dev) 80493746Sjulian{ 80593746Sjulian int s, i; 80693746Sjulian u_char eaddr[ETHER_ADDR_LEN]; 807148946Sjhb u_int32_t iobase; 80893746Sjulian struct my_softc *sc; 80993746Sjulian struct ifnet *ifp; 81093746Sjulian int media = IFM_ETHER | IFM_100_TX | IFM_FDX; 81193746Sjulian unsigned int round; 81293746Sjulian caddr_t roundptr; 81393746Sjulian struct my_type *p; 81493746Sjulian u_int16_t phy_vid, phy_did, phy_sts = 0; 815148945Sjhb int rid, error = 0; 81693746Sjulian 81793746Sjulian s = splimp(); 81893746Sjulian sc = device_get_softc(dev); 81995803Sjulian mtx_init(&sc->my_mtx, device_get_nameunit(dev), MTX_NETWORK_LOCK, 82095803Sjulian MTX_DEF | MTX_RECURSE); 82193746Sjulian MY_LOCK(sc); 82293746Sjulian 82393746Sjulian /* 82493746Sjulian * Map control/status registers. 82593746Sjulian */ 826148946Sjhb pci_enable_busmaster(dev); 82793746Sjulian 82893746Sjulian if (my_info_tmp->my_did == MTD800ID) { 82993746Sjulian iobase = pci_read_config(dev, MY_PCI_LOIO, 4); 83093746Sjulian if (iobase & 0x300) 83193746Sjulian MY_USEIOSPACE = 0; 83293746Sjulian } 83393746Sjulian 83493746Sjulian rid = MY_RID; 835127135Snjl sc->my_res = bus_alloc_resource_any(dev, MY_RES, &rid, RF_ACTIVE); 83693746Sjulian 83793746Sjulian if (sc->my_res == NULL) { 838148945Sjhb device_printf(dev, "couldn't map ports/memory\n"); 83993746Sjulian error = ENXIO; 84093746Sjulian goto fail; 84193746Sjulian } 84293746Sjulian sc->my_btag = rman_get_bustag(sc->my_res); 84393746Sjulian sc->my_bhandle = rman_get_bushandle(sc->my_res); 84493746Sjulian 84593746Sjulian rid = 0; 846127135Snjl sc->my_irq = bus_alloc_resource_any(dev, SYS_RES_IRQ, &rid, 847127135Snjl RF_SHAREABLE | RF_ACTIVE); 84893746Sjulian 84993746Sjulian if (sc->my_irq == NULL) { 850148945Sjhb device_printf(dev, "couldn't map interrupt\n"); 85193746Sjulian bus_release_resource(dev, MY_RES, MY_RID, sc->my_res); 85293746Sjulian error = ENXIO; 85393746Sjulian goto fail; 85493746Sjulian } 85593746Sjulian error = bus_setup_intr(dev, sc->my_irq, INTR_TYPE_NET, 85693746Sjulian my_intr, sc, &sc->my_intrhand); 85793746Sjulian 85893746Sjulian if (error) { 85993746Sjulian bus_release_resource(dev, SYS_RES_IRQ, 0, sc->my_irq); 86093746Sjulian bus_release_resource(dev, MY_RES, MY_RID, sc->my_res); 861148945Sjhb device_printf(dev, "couldn't set up irq\n"); 86293746Sjulian goto fail; 86393746Sjulian } 86493746Sjulian callout_handle_init(&sc->my_stat_ch); 86593746Sjulian 86693746Sjulian sc->my_info = my_info_tmp; 86793746Sjulian 86893746Sjulian /* Reset the adapter. */ 86993746Sjulian my_reset(sc); 87093746Sjulian 87193746Sjulian /* 87293746Sjulian * Get station address 87393746Sjulian */ 87493746Sjulian for (i = 0; i < ETHER_ADDR_LEN; ++i) 87593746Sjulian eaddr[i] = CSR_READ_1(sc, MY_PAR0 + i); 87693746Sjulian 87793746Sjulian sc->my_ldata_ptr = malloc(sizeof(struct my_list_data) + 8, 87893746Sjulian M_DEVBUF, M_NOWAIT); 87993746Sjulian if (sc->my_ldata_ptr == NULL) { 880148945Sjhb device_printf(dev, "no memory for list buffers!\n"); 88193746Sjulian error = ENXIO; 88293746Sjulian goto fail; 88393746Sjulian } 88493746Sjulian sc->my_ldata = (struct my_list_data *) sc->my_ldata_ptr; 885106588Sjhb round = (uintptr_t)sc->my_ldata_ptr & 0xF; 88693746Sjulian roundptr = sc->my_ldata_ptr; 88793746Sjulian for (i = 0; i < 8; i++) { 88893746Sjulian if (round % 8) { 88993746Sjulian round++; 89093746Sjulian roundptr++; 89193746Sjulian } else 89293746Sjulian break; 89393746Sjulian } 89493746Sjulian sc->my_ldata = (struct my_list_data *) roundptr; 89593746Sjulian bzero(sc->my_ldata, sizeof(struct my_list_data)); 89693746Sjulian 897147256Sbrooks ifp = sc->my_ifp = if_alloc(IFT_ETHER); 898147256Sbrooks if (ifp == NULL) { 899147256Sbrooks device_printf(dev, "can not if_alloc()\n"); 900147256Sbrooks error = ENOSPC; 901147256Sbrooks goto fail; 902147256Sbrooks } 90393746Sjulian ifp->if_softc = sc; 904121816Sbrooks if_initname(ifp, device_get_name(dev), device_get_unit(dev)); 90593746Sjulian ifp->if_mtu = ETHERMTU; 90693746Sjulian ifp->if_flags = IFF_BROADCAST | IFF_SIMPLEX | IFF_MULTICAST; 90793746Sjulian ifp->if_ioctl = my_ioctl; 90893746Sjulian ifp->if_start = my_start; 90993746Sjulian ifp->if_watchdog = my_watchdog; 91093746Sjulian ifp->if_init = my_init; 91193746Sjulian ifp->if_baudrate = 10000000; 91293746Sjulian ifp->if_snd.ifq_maxlen = IFQ_MAXLEN; 91393746Sjulian 91493746Sjulian if (sc->my_info->my_did == MTD803ID) 91593746Sjulian sc->my_pinfo = my_phys; 91693746Sjulian else { 91793746Sjulian if (bootverbose) 918148945Sjhb device_printf(dev, "probing for a PHY\n"); 91993746Sjulian for (i = MY_PHYADDR_MIN; i < MY_PHYADDR_MAX + 1; i++) { 92093746Sjulian if (bootverbose) 921148945Sjhb device_printf(dev, "checking address: %d\n", i); 92293746Sjulian sc->my_phy_addr = i; 92393746Sjulian phy_sts = my_phy_readreg(sc, PHY_BMSR); 92493746Sjulian if ((phy_sts != 0) && (phy_sts != 0xffff)) 92593746Sjulian break; 92693746Sjulian else 92793746Sjulian phy_sts = 0; 92893746Sjulian } 92993746Sjulian if (phy_sts) { 93093746Sjulian phy_vid = my_phy_readreg(sc, PHY_VENID); 93193746Sjulian phy_did = my_phy_readreg(sc, PHY_DEVID); 93293746Sjulian if (bootverbose) { 933148945Sjhb device_printf(dev, "found PHY at address %d, ", 934148945Sjhb sc->my_phy_addr); 93593746Sjulian printf("vendor id: %x device id: %x\n", 93693746Sjulian phy_vid, phy_did); 93793746Sjulian } 93893746Sjulian p = my_phys; 93993746Sjulian while (p->my_vid) { 94093746Sjulian if (phy_vid == p->my_vid) { 94193746Sjulian sc->my_pinfo = p; 94293746Sjulian break; 94393746Sjulian } 94493746Sjulian p++; 94593746Sjulian } 94693746Sjulian if (sc->my_pinfo == NULL) 94793746Sjulian sc->my_pinfo = &my_phys[PHY_UNKNOWN]; 94893746Sjulian if (bootverbose) 949148945Sjhb device_printf(dev, "PHY type: %s\n", 950148945Sjhb sc->my_pinfo->my_name); 95193746Sjulian } else { 952148945Sjhb device_printf(dev, "MII without any phy!\n"); 95393746Sjulian error = ENXIO; 95493746Sjulian goto fail; 95593746Sjulian } 95693746Sjulian } 95793746Sjulian 95893746Sjulian /* Do ifmedia setup. */ 95993746Sjulian ifmedia_init(&sc->ifmedia, 0, my_ifmedia_upd, my_ifmedia_sts); 96093746Sjulian my_getmode_mii(sc); 96193746Sjulian my_autoneg_mii(sc, MY_FLAG_FORCEDELAY, 1); 96293746Sjulian media = sc->ifmedia.ifm_media; 96393746Sjulian my_stop(sc); 96493746Sjulian ifmedia_set(&sc->ifmedia, media); 96593746Sjulian 966106937Ssam ether_ifattach(ifp, eaddr); 96793746Sjulian 96893746Sjulian MY_UNLOCK(sc); 96993746Sjulian return (0); 97093746Sjulian 97193746Sjulianfail: 97293746Sjulian MY_UNLOCK(sc); 97393746Sjulian mtx_destroy(&sc->my_mtx); 974147256Sbrooks if (sc->my_ldata_ptr != NULL) 975147256Sbrooks free(sc->my_ldata_ptr, M_DEVBUF); 97693746Sjulian splx(s); 97793746Sjulian return (error); 97893746Sjulian} 97993746Sjulian 98093746Sjulianstatic int 98193746Sjulianmy_detach(device_t dev) 98293746Sjulian{ 98393746Sjulian struct my_softc *sc; 98493746Sjulian struct ifnet *ifp; 98593746Sjulian int s; 98693746Sjulian 98793746Sjulian s = splimp(); 98893746Sjulian sc = device_get_softc(dev); 98993746Sjulian MY_LOCK(sc); 990147256Sbrooks ifp = sc->my_ifp; 991106937Ssam ether_ifdetach(ifp); 992147256Sbrooks if_free(ifp); 99393746Sjulian my_stop(sc); 99493746Sjulian 99593746Sjulian bus_teardown_intr(dev, sc->my_irq, sc->my_intrhand); 99693746Sjulian bus_release_resource(dev, SYS_RES_IRQ, 0, sc->my_irq); 99793746Sjulian bus_release_resource(dev, MY_RES, MY_RID, sc->my_res); 99893746Sjulian MY_UNLOCK(sc); 99993746Sjulian splx(s); 100093746Sjulian mtx_destroy(&sc->my_mtx); 100193746Sjulian return (0); 100293746Sjulian} 100393746Sjulian 100493746Sjulian 100593746Sjulian/* 100693746Sjulian * Initialize the transmit descriptors. 100793746Sjulian */ 100893746Sjulianstatic int 100993746Sjulianmy_list_tx_init(struct my_softc * sc) 101093746Sjulian{ 101193746Sjulian struct my_chain_data *cd; 101293746Sjulian struct my_list_data *ld; 101393746Sjulian int i; 101493746Sjulian 101593746Sjulian MY_LOCK(sc); 101693746Sjulian cd = &sc->my_cdata; 101793746Sjulian ld = sc->my_ldata; 101893746Sjulian for (i = 0; i < MY_TX_LIST_CNT; i++) { 101993746Sjulian cd->my_tx_chain[i].my_ptr = &ld->my_tx_list[i]; 102093746Sjulian if (i == (MY_TX_LIST_CNT - 1)) 102193746Sjulian cd->my_tx_chain[i].my_nextdesc = &cd->my_tx_chain[0]; 102293746Sjulian else 102393746Sjulian cd->my_tx_chain[i].my_nextdesc = 102493746Sjulian &cd->my_tx_chain[i + 1]; 102593746Sjulian } 102693746Sjulian cd->my_tx_free = &cd->my_tx_chain[0]; 102793746Sjulian cd->my_tx_tail = cd->my_tx_head = NULL; 102893746Sjulian MY_UNLOCK(sc); 102993746Sjulian return (0); 103093746Sjulian} 103193746Sjulian 103293746Sjulian/* 103393746Sjulian * Initialize the RX descriptors and allocate mbufs for them. Note that we 103493746Sjulian * arrange the descriptors in a closed ring, so that the last descriptor 103593746Sjulian * points back to the first. 103693746Sjulian */ 103793746Sjulianstatic int 103893746Sjulianmy_list_rx_init(struct my_softc * sc) 103993746Sjulian{ 104093746Sjulian struct my_chain_data *cd; 104193746Sjulian struct my_list_data *ld; 104293746Sjulian int i; 104393746Sjulian 104493746Sjulian MY_LOCK(sc); 104593746Sjulian cd = &sc->my_cdata; 104693746Sjulian ld = sc->my_ldata; 104793746Sjulian for (i = 0; i < MY_RX_LIST_CNT; i++) { 104893746Sjulian cd->my_rx_chain[i].my_ptr = 104993746Sjulian (struct my_desc *) & ld->my_rx_list[i]; 105097641Sjulian if (my_newbuf(sc, &cd->my_rx_chain[i]) == ENOBUFS) { 105197641Sjulian MY_UNLOCK(sc); 105293746Sjulian return (ENOBUFS); 105397641Sjulian } 105493746Sjulian if (i == (MY_RX_LIST_CNT - 1)) { 105593746Sjulian cd->my_rx_chain[i].my_nextdesc = &cd->my_rx_chain[0]; 105693746Sjulian ld->my_rx_list[i].my_next = vtophys(&ld->my_rx_list[0]); 105793746Sjulian } else { 105893746Sjulian cd->my_rx_chain[i].my_nextdesc = 105993746Sjulian &cd->my_rx_chain[i + 1]; 106093746Sjulian ld->my_rx_list[i].my_next = 106193746Sjulian vtophys(&ld->my_rx_list[i + 1]); 106293746Sjulian } 106393746Sjulian } 106493746Sjulian cd->my_rx_head = &cd->my_rx_chain[0]; 106593746Sjulian MY_UNLOCK(sc); 106693746Sjulian return (0); 106793746Sjulian} 106893746Sjulian 106993746Sjulian/* 107093746Sjulian * Initialize an RX descriptor and attach an MBUF cluster. 107193746Sjulian */ 107293746Sjulianstatic int 107393746Sjulianmy_newbuf(struct my_softc * sc, struct my_chain_onefrag * c) 107493746Sjulian{ 107593746Sjulian struct mbuf *m_new = NULL; 107693746Sjulian 107793746Sjulian MY_LOCK(sc); 1078111119Simp MGETHDR(m_new, M_DONTWAIT, MT_DATA); 107993746Sjulian if (m_new == NULL) { 1080148945Sjhb if_printf(sc->my_ifp, 1081148945Sjhb "no memory for rx list -- packet dropped!\n"); 108295939Sjulian MY_UNLOCK(sc); 108393746Sjulian return (ENOBUFS); 108493746Sjulian } 1085111119Simp MCLGET(m_new, M_DONTWAIT); 108693746Sjulian if (!(m_new->m_flags & M_EXT)) { 1087148945Sjhb if_printf(sc->my_ifp, 1088148945Sjhb "no memory for rx list -- packet dropped!\n"); 108993746Sjulian m_freem(m_new); 109095939Sjulian MY_UNLOCK(sc); 109193746Sjulian return (ENOBUFS); 109293746Sjulian } 109393746Sjulian c->my_mbuf = m_new; 109493746Sjulian c->my_ptr->my_data = vtophys(mtod(m_new, caddr_t)); 109593746Sjulian c->my_ptr->my_ctl = (MCLBYTES - 1) << MY_RBSShift; 109693746Sjulian c->my_ptr->my_status = MY_OWNByNIC; 109793746Sjulian MY_UNLOCK(sc); 109893746Sjulian return (0); 109993746Sjulian} 110093746Sjulian 110193746Sjulian/* 110293746Sjulian * A frame has been uploaded: pass the resulting mbuf chain up to the higher 110393746Sjulian * level protocols. 110493746Sjulian */ 110593746Sjulianstatic void 110693746Sjulianmy_rxeof(struct my_softc * sc) 110793746Sjulian{ 110893746Sjulian struct ether_header *eh; 110993746Sjulian struct mbuf *m; 111093746Sjulian struct ifnet *ifp; 111193746Sjulian struct my_chain_onefrag *cur_rx; 111293746Sjulian int total_len = 0; 111393746Sjulian u_int32_t rxstat; 111493746Sjulian 111593746Sjulian MY_LOCK(sc); 1116147256Sbrooks ifp = sc->my_ifp; 111793746Sjulian while (!((rxstat = sc->my_cdata.my_rx_head->my_ptr->my_status) 111893746Sjulian & MY_OWNByNIC)) { 111993746Sjulian cur_rx = sc->my_cdata.my_rx_head; 112093746Sjulian sc->my_cdata.my_rx_head = cur_rx->my_nextdesc; 112193746Sjulian 112293746Sjulian if (rxstat & MY_ES) { /* error summary: give up this rx pkt */ 112393746Sjulian ifp->if_ierrors++; 112493746Sjulian cur_rx->my_ptr->my_status = MY_OWNByNIC; 112593746Sjulian continue; 112693746Sjulian } 112793746Sjulian /* No errors; receive the packet. */ 112893746Sjulian total_len = (rxstat & MY_FLNGMASK) >> MY_FLNGShift; 112993746Sjulian total_len -= ETHER_CRC_LEN; 113093746Sjulian 113193746Sjulian if (total_len < MINCLSIZE) { 113293746Sjulian m = m_devget(mtod(cur_rx->my_mbuf, char *), 113393746Sjulian total_len, 0, ifp, NULL); 113493746Sjulian cur_rx->my_ptr->my_status = MY_OWNByNIC; 113593746Sjulian if (m == NULL) { 113693746Sjulian ifp->if_ierrors++; 113793746Sjulian continue; 113893746Sjulian } 113993746Sjulian } else { 114093746Sjulian m = cur_rx->my_mbuf; 114193746Sjulian /* 114293746Sjulian * Try to conjure up a new mbuf cluster. If that 114393746Sjulian * fails, it means we have an out of memory condition 114493746Sjulian * and should leave the buffer in place and continue. 114593746Sjulian * This will result in a lost packet, but there's 114693746Sjulian * little else we can do in this situation. 114793746Sjulian */ 114893746Sjulian if (my_newbuf(sc, cur_rx) == ENOBUFS) { 114993746Sjulian ifp->if_ierrors++; 115093746Sjulian cur_rx->my_ptr->my_status = MY_OWNByNIC; 115193746Sjulian continue; 115293746Sjulian } 115393746Sjulian m->m_pkthdr.rcvif = ifp; 115493746Sjulian m->m_pkthdr.len = m->m_len = total_len; 115593746Sjulian } 115693746Sjulian ifp->if_ipackets++; 115793746Sjulian eh = mtod(m, struct ether_header *); 115893746Sjulian#if NBPFILTER > 0 115993746Sjulian /* 116093746Sjulian * Handle BPF listeners. Let the BPF user see the packet, but 116193746Sjulian * don't pass it up to the ether_input() layer unless it's a 116293746Sjulian * broadcast packet, multicast packet, matches our ethernet 116393746Sjulian * address or the interface is in promiscuous mode. 116493746Sjulian */ 116593746Sjulian if (ifp->if_bpf) { 1166106937Ssam BPF_MTAP(ifp, m); 116793746Sjulian if (ifp->if_flags & IFF_PROMISC && 1168147256Sbrooks (bcmp(eh->ether_dhost, IFP2ENADDR(sc->my_ifp), 116993746Sjulian ETHER_ADDR_LEN) && 117093746Sjulian (eh->ether_dhost[0] & 1) == 0)) { 117193746Sjulian m_freem(m); 117293746Sjulian continue; 117393746Sjulian } 117493746Sjulian } 117593746Sjulian#endif 1176122689Ssam MY_UNLOCK(sc); 1177106937Ssam (*ifp->if_input)(ifp, m); 1178122689Ssam MY_LOCK(sc); 117993746Sjulian } 118093746Sjulian MY_UNLOCK(sc); 118193746Sjulian return; 118293746Sjulian} 118393746Sjulian 118493746Sjulian 118593746Sjulian/* 118693746Sjulian * A frame was downloaded to the chip. It's safe for us to clean up the list 118793746Sjulian * buffers. 118893746Sjulian */ 118993746Sjulianstatic void 119093746Sjulianmy_txeof(struct my_softc * sc) 119193746Sjulian{ 119293746Sjulian struct my_chain *cur_tx; 119393746Sjulian struct ifnet *ifp; 119493746Sjulian 119593746Sjulian MY_LOCK(sc); 1196147256Sbrooks ifp = sc->my_ifp; 119793746Sjulian /* Clear the timeout timer. */ 119893746Sjulian ifp->if_timer = 0; 119995939Sjulian if (sc->my_cdata.my_tx_head == NULL) { 120095939Sjulian MY_UNLOCK(sc); 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) { 121693746Sjulian ifp->if_oerrors++; 121793746Sjulian if (txstat & MY_EC) /* excessive collision */ 121893746Sjulian ifp->if_collisions++; 121993746Sjulian if (txstat & MY_LC) /* late collision */ 122093746Sjulian ifp->if_collisions++; 122193746Sjulian } 122293746Sjulian ifp->if_collisions += (txstat & MY_NCRMASK) >> 122393746Sjulian MY_NCRShift; 122493746Sjulian } 122593746Sjulian ifp->if_opackets++; 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) { 123693746Sjulian ifp->if_collisions += (CSR_READ_4(sc, MY_TSR) & MY_NCRMask); 123793746Sjulian } 123893746Sjulian MY_UNLOCK(sc); 123993746Sjulian return; 124093746Sjulian} 124193746Sjulian 124293746Sjulian/* 124393746Sjulian * TX 'end of channel' interrupt handler. 124493746Sjulian */ 124593746Sjulianstatic void 124693746Sjulianmy_txeoc(struct my_softc * sc) 124793746Sjulian{ 124893746Sjulian struct ifnet *ifp; 124993746Sjulian 125093746Sjulian MY_LOCK(sc); 1251147256Sbrooks ifp = sc->my_ifp; 125293746Sjulian ifp->if_timer = 0; 125393746Sjulian if (sc->my_cdata.my_tx_head == NULL) { 1254148887Srwatson ifp->if_drv_flags &= ~IFF_DRV_OACTIVE; 125593746Sjulian sc->my_cdata.my_tx_tail = NULL; 125693746Sjulian if (sc->my_want_auto) 125793746Sjulian my_autoneg_mii(sc, MY_FLAG_SCHEDDELAY, 1); 125893746Sjulian } else { 125993746Sjulian if (MY_TXOWN(sc->my_cdata.my_tx_head) == MY_UNSENT) { 126093746Sjulian MY_TXOWN(sc->my_cdata.my_tx_head) = MY_OWNByNIC; 126193746Sjulian ifp->if_timer = 5; 126293746Sjulian CSR_WRITE_4(sc, MY_TXPDR, 0xFFFFFFFF); 126393746Sjulian } 126493746Sjulian } 126593746Sjulian MY_UNLOCK(sc); 126693746Sjulian return; 126793746Sjulian} 126893746Sjulian 126993746Sjulianstatic void 127093746Sjulianmy_intr(void *arg) 127193746Sjulian{ 127293746Sjulian struct my_softc *sc; 127393746Sjulian struct ifnet *ifp; 127493746Sjulian u_int32_t status; 127593746Sjulian 127693746Sjulian sc = arg; 127793746Sjulian MY_LOCK(sc); 1278147256Sbrooks ifp = sc->my_ifp; 127993746Sjulian if (!(ifp->if_flags & IFF_UP)) { 128093746Sjulian MY_UNLOCK(sc); 128193746Sjulian return; 128293746Sjulian } 128393746Sjulian /* Disable interrupts. */ 128493746Sjulian CSR_WRITE_4(sc, MY_IMR, 0x00000000); 128593746Sjulian 128693746Sjulian for (;;) { 128793746Sjulian status = CSR_READ_4(sc, MY_ISR); 128893746Sjulian status &= MY_INTRS; 128993746Sjulian if (status) 129093746Sjulian CSR_WRITE_4(sc, MY_ISR, status); 129193746Sjulian else 129293746Sjulian break; 129393746Sjulian 129493746Sjulian if (status & MY_RI) /* receive interrupt */ 129593746Sjulian my_rxeof(sc); 129693746Sjulian 129793746Sjulian if ((status & MY_RBU) || (status & MY_RxErr)) { 129893746Sjulian /* rx buffer unavailable or rx error */ 129993746Sjulian ifp->if_ierrors++; 130093746Sjulian#ifdef foo 130193746Sjulian my_stop(sc); 130293746Sjulian my_reset(sc); 130393746Sjulian my_init(sc); 130493746Sjulian#endif 130593746Sjulian } 130693746Sjulian if (status & MY_TI) /* tx interrupt */ 130793746Sjulian my_txeof(sc); 130893746Sjulian if (status & MY_ETI) /* tx early interrupt */ 130993746Sjulian my_txeof(sc); 131093746Sjulian if (status & MY_TBU) /* tx buffer unavailable */ 131193746Sjulian my_txeoc(sc); 131294863Sjulian 131394863Sjulian#if 0 /* 90/1/18 delete */ 131494863Sjulian if (status & MY_FBE) { 131594863Sjulian my_reset(sc); 131694863Sjulian my_init(sc); 131794863Sjulian } 131894863Sjulian#endif 131994863Sjulian 132093746Sjulian } 132193746Sjulian 132293746Sjulian /* Re-enable interrupts. */ 132393746Sjulian CSR_WRITE_4(sc, MY_IMR, MY_INTRS); 132493746Sjulian if (ifp->if_snd.ifq_head != NULL) 132593746Sjulian my_start(ifp); 132693746Sjulian MY_UNLOCK(sc); 132793746Sjulian return; 132893746Sjulian} 132993746Sjulian 133093746Sjulian/* 133193746Sjulian * Encapsulate an mbuf chain in a descriptor by coupling the mbuf data 133293746Sjulian * pointers to the fragment pointers. 133393746Sjulian */ 133493746Sjulianstatic int 133593746Sjulianmy_encap(struct my_softc * sc, struct my_chain * c, struct mbuf * m_head) 133693746Sjulian{ 133793746Sjulian struct my_desc *f = NULL; 133893746Sjulian int total_len; 133993746Sjulian struct mbuf *m, *m_new = NULL; 134093746Sjulian 134193746Sjulian MY_LOCK(sc); 134293746Sjulian /* calculate the total tx pkt length */ 134393746Sjulian total_len = 0; 134493746Sjulian for (m = m_head; m != NULL; m = m->m_next) 134593746Sjulian total_len += m->m_len; 134693746Sjulian /* 134793746Sjulian * Start packing the mbufs in this chain into the fragment pointers. 134893746Sjulian * Stop when we run out of fragments or hit the end of the mbuf 134993746Sjulian * chain. 135093746Sjulian */ 135193746Sjulian m = m_head; 1352111119Simp MGETHDR(m_new, M_DONTWAIT, MT_DATA); 135393746Sjulian if (m_new == NULL) { 1354148945Sjhb if_printf(sc->my_ifp, "no memory for tx list"); 135595939Sjulian MY_UNLOCK(sc); 135693746Sjulian return (1); 135793746Sjulian } 135893746Sjulian if (m_head->m_pkthdr.len > MHLEN) { 1359111119Simp MCLGET(m_new, M_DONTWAIT); 136093746Sjulian if (!(m_new->m_flags & M_EXT)) { 136193746Sjulian m_freem(m_new); 1362148945Sjhb if_printf(sc->my_ifp, "no memory for tx list"); 136395939Sjulian MY_UNLOCK(sc); 136493746Sjulian return (1); 136593746Sjulian } 136693746Sjulian } 136793746Sjulian m_copydata(m_head, 0, m_head->m_pkthdr.len, mtod(m_new, caddr_t)); 136893746Sjulian m_new->m_pkthdr.len = m_new->m_len = m_head->m_pkthdr.len; 136993746Sjulian m_freem(m_head); 137093746Sjulian m_head = m_new; 137193746Sjulian f = &c->my_ptr->my_frag[0]; 137293746Sjulian f->my_status = 0; 137393746Sjulian f->my_data = vtophys(mtod(m_new, caddr_t)); 137493746Sjulian total_len = m_new->m_len; 137593746Sjulian f->my_ctl = MY_TXFD | MY_TXLD | MY_CRCEnable | MY_PADEnable; 137693746Sjulian f->my_ctl |= total_len << MY_PKTShift; /* pkt size */ 137793746Sjulian f->my_ctl |= total_len; /* buffer size */ 137894904Sjulian /* 89/12/29 add, for mtd891 *//* [ 89? ] */ 137993746Sjulian if (sc->my_info->my_did == MTD891ID) 138093746Sjulian f->my_ctl |= MY_ETIControl | MY_RetryTxLC; 138193746Sjulian c->my_mbuf = m_head; 138293746Sjulian c->my_lastdesc = 0; 138393746Sjulian MY_TXNEXT(c) = vtophys(&c->my_nextdesc->my_ptr->my_frag[0]); 138493746Sjulian MY_UNLOCK(sc); 138593746Sjulian return (0); 138693746Sjulian} 138793746Sjulian 138893746Sjulian/* 138993746Sjulian * Main transmit routine. To avoid having to do mbuf copies, we put pointers 139093746Sjulian * to the mbuf data regions directly in the transmit lists. We also save a 139193746Sjulian * copy of the pointers since the transmit list fragment pointers are 139293746Sjulian * physical addresses. 139393746Sjulian */ 139493746Sjulianstatic void 139593746Sjulianmy_start(struct ifnet * ifp) 139693746Sjulian{ 139793746Sjulian struct my_softc *sc; 139893746Sjulian struct mbuf *m_head = NULL; 139993746Sjulian struct my_chain *cur_tx = NULL, *start_tx; 140093746Sjulian 140193746Sjulian sc = ifp->if_softc; 140293746Sjulian MY_LOCK(sc); 140393746Sjulian if (sc->my_autoneg) { 140493746Sjulian sc->my_tx_pend = 1; 140593746Sjulian MY_UNLOCK(sc); 140693746Sjulian return; 140793746Sjulian } 140893746Sjulian /* 140993746Sjulian * Check for an available queue slot. If there are none, punt. 141093746Sjulian */ 141193746Sjulian if (sc->my_cdata.my_tx_free->my_mbuf != NULL) { 1412148887Srwatson ifp->if_drv_flags |= IFF_DRV_OACTIVE; 141393746Sjulian MY_UNLOCK(sc); 141493746Sjulian return; 141593746Sjulian } 141693746Sjulian start_tx = sc->my_cdata.my_tx_free; 141793746Sjulian while (sc->my_cdata.my_tx_free->my_mbuf == NULL) { 141893746Sjulian IF_DEQUEUE(&ifp->if_snd, m_head); 141993746Sjulian if (m_head == NULL) 142093746Sjulian break; 142193746Sjulian 142293746Sjulian /* Pick a descriptor off the free list. */ 142393746Sjulian cur_tx = sc->my_cdata.my_tx_free; 142493746Sjulian sc->my_cdata.my_tx_free = cur_tx->my_nextdesc; 142593746Sjulian 142693746Sjulian /* Pack the data into the descriptor. */ 142793746Sjulian my_encap(sc, cur_tx, m_head); 142893746Sjulian 142993746Sjulian if (cur_tx != start_tx) 143093746Sjulian MY_TXOWN(cur_tx) = MY_OWNByNIC; 143193746Sjulian#if NBPFILTER > 0 143293746Sjulian /* 143393746Sjulian * If there's a BPF listener, bounce a copy of this frame to 143493746Sjulian * him. 143593746Sjulian */ 1436106937Ssam BPF_MTAP(ifp, cur_tx->my_mbuf); 143793746Sjulian#endif 143893746Sjulian } 143993746Sjulian /* 144093746Sjulian * If there are no packets queued, bail. 144193746Sjulian */ 144293746Sjulian if (cur_tx == NULL) { 144393746Sjulian MY_UNLOCK(sc); 144493746Sjulian return; 144593746Sjulian } 144693746Sjulian /* 144793746Sjulian * Place the request for the upload interrupt in the last descriptor 144893746Sjulian * in the chain. This way, if we're chaining several packets at once, 144993746Sjulian * we'll only get an interupt once for the whole chain rather than 145093746Sjulian * once for each packet. 145193746Sjulian */ 145293746Sjulian MY_TXCTL(cur_tx) |= MY_TXIC; 145393746Sjulian cur_tx->my_ptr->my_frag[0].my_ctl |= MY_TXIC; 145493746Sjulian sc->my_cdata.my_tx_tail = cur_tx; 145593746Sjulian if (sc->my_cdata.my_tx_head == NULL) 145693746Sjulian sc->my_cdata.my_tx_head = start_tx; 145793746Sjulian MY_TXOWN(start_tx) = MY_OWNByNIC; 145893746Sjulian CSR_WRITE_4(sc, MY_TXPDR, 0xFFFFFFFF); /* tx polling demand */ 145993746Sjulian 146093746Sjulian /* 146193746Sjulian * Set a timeout in case the chip goes out to lunch. 146293746Sjulian */ 146393746Sjulian ifp->if_timer = 5; 146493746Sjulian MY_UNLOCK(sc); 146593746Sjulian return; 146693746Sjulian} 146793746Sjulian 146893746Sjulianstatic void 146993746Sjulianmy_init(void *xsc) 147093746Sjulian{ 147193746Sjulian struct my_softc *sc = xsc; 1472147256Sbrooks struct ifnet *ifp = sc->my_ifp; 147393746Sjulian int s; 147493746Sjulian u_int16_t phy_bmcr = 0; 147593746Sjulian 147693746Sjulian MY_LOCK(sc); 147793746Sjulian if (sc->my_autoneg) { 147893746Sjulian MY_UNLOCK(sc); 147993746Sjulian return; 148093746Sjulian } 148193746Sjulian s = splimp(); 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) { 1509148945Sjhb if_printf(ifp, "init failed: no memory for rx buffers\n"); 151093746Sjulian my_stop(sc); 151193746Sjulian (void)splx(s); 151293746Sjulian MY_UNLOCK(sc); 151393746Sjulian return; 151493746Sjulian } 151593746Sjulian /* Init TX descriptors. */ 151693746Sjulian my_list_tx_init(sc); 151793746Sjulian 151893746Sjulian /* If we want promiscuous mode, set the allframes bit. */ 151993746Sjulian if (ifp->if_flags & IFF_PROMISC) 152093746Sjulian MY_SETBIT(sc, MY_TCRRCR, MY_PROM); 152193746Sjulian else 152293746Sjulian MY_CLRBIT(sc, MY_TCRRCR, MY_PROM); 152393746Sjulian 152493746Sjulian /* 152593746Sjulian * Set capture broadcast bit to capture broadcast frames. 152693746Sjulian */ 152793746Sjulian if (ifp->if_flags & IFF_BROADCAST) 152893746Sjulian MY_SETBIT(sc, MY_TCRRCR, MY_AB); 152993746Sjulian else 153093746Sjulian MY_CLRBIT(sc, MY_TCRRCR, MY_AB); 153193746Sjulian 153293746Sjulian /* 153393746Sjulian * Program the multicast filter, if necessary. 153493746Sjulian */ 153593746Sjulian my_setmulti(sc); 153693746Sjulian 153793746Sjulian /* 153893746Sjulian * Load the address of the RX list. 153993746Sjulian */ 154093746Sjulian MY_CLRBIT(sc, MY_TCRRCR, MY_RE); 154193746Sjulian CSR_WRITE_4(sc, MY_RXLBA, vtophys(&sc->my_ldata->my_rx_list[0])); 154293746Sjulian 154393746Sjulian /* 154493746Sjulian * Enable interrupts. 154593746Sjulian */ 154693746Sjulian CSR_WRITE_4(sc, MY_IMR, MY_INTRS); 154793746Sjulian CSR_WRITE_4(sc, MY_ISR, 0xFFFFFFFF); 154893746Sjulian 154993746Sjulian /* Enable receiver and transmitter. */ 155093746Sjulian MY_SETBIT(sc, MY_TCRRCR, MY_RE); 155193746Sjulian MY_CLRBIT(sc, MY_TCRRCR, MY_TE); 155293746Sjulian CSR_WRITE_4(sc, MY_TXLBA, vtophys(&sc->my_ldata->my_tx_list[0])); 155393746Sjulian MY_SETBIT(sc, MY_TCRRCR, MY_TE); 155493746Sjulian 155593746Sjulian /* Restore state of BMCR */ 155693746Sjulian if (sc->my_pinfo != NULL) 155793746Sjulian my_phy_writereg(sc, PHY_BMCR, phy_bmcr); 1558148887Srwatson ifp->if_drv_flags |= IFF_DRV_RUNNING; 1559148887Srwatson ifp->if_drv_flags &= ~IFF_DRV_OACTIVE; 156093746Sjulian (void)splx(s); 156193746Sjulian MY_UNLOCK(sc); 156293746Sjulian return; 156393746Sjulian} 156493746Sjulian 156593746Sjulian/* 156693746Sjulian * Set media options. 156793746Sjulian */ 156893746Sjulian 156993746Sjulianstatic int 157093746Sjulianmy_ifmedia_upd(struct ifnet * ifp) 157193746Sjulian{ 157293746Sjulian struct my_softc *sc; 157393746Sjulian struct ifmedia *ifm; 157493746Sjulian 157593746Sjulian sc = ifp->if_softc; 157693746Sjulian MY_LOCK(sc); 157793746Sjulian ifm = &sc->ifmedia; 157893746Sjulian if (IFM_TYPE(ifm->ifm_media) != IFM_ETHER) { 157993746Sjulian MY_UNLOCK(sc); 158093746Sjulian return (EINVAL); 158193746Sjulian } 158293746Sjulian if (IFM_SUBTYPE(ifm->ifm_media) == IFM_AUTO) 158393746Sjulian my_autoneg_mii(sc, MY_FLAG_SCHEDDELAY, 1); 158493746Sjulian else 158593746Sjulian my_setmode_mii(sc, ifm->ifm_media); 158693746Sjulian MY_UNLOCK(sc); 158793746Sjulian return (0); 158893746Sjulian} 158993746Sjulian 159093746Sjulian/* 159193746Sjulian * Report current media status. 159293746Sjulian */ 159393746Sjulian 159493746Sjulianstatic void 159593746Sjulianmy_ifmedia_sts(struct ifnet * ifp, struct ifmediareq * ifmr) 159693746Sjulian{ 159793746Sjulian struct my_softc *sc; 159893746Sjulian u_int16_t advert = 0, ability = 0; 159993746Sjulian 160093746Sjulian sc = ifp->if_softc; 160193746Sjulian MY_LOCK(sc); 160293746Sjulian ifmr->ifm_active = IFM_ETHER; 160393746Sjulian if (!(my_phy_readreg(sc, PHY_BMCR) & PHY_BMCR_AUTONEGENBL)) { 160494863Sjulian#if 0 /* this version did not support 1000M, */ 160594863Sjulian if (my_phy_readreg(sc, PHY_BMCR) & PHY_BMCR_1000) 160694863Sjulian ifmr->ifm_active = IFM_ETHER | IFM_1000TX; 160794863Sjulian#endif 160893746Sjulian if (my_phy_readreg(sc, PHY_BMCR) & PHY_BMCR_SPEEDSEL) 160993746Sjulian ifmr->ifm_active = IFM_ETHER | IFM_100_TX; 161093746Sjulian else 161193746Sjulian ifmr->ifm_active = IFM_ETHER | IFM_10_T; 161293746Sjulian if (my_phy_readreg(sc, PHY_BMCR) & PHY_BMCR_DUPLEX) 161393746Sjulian ifmr->ifm_active |= IFM_FDX; 161493746Sjulian else 161593746Sjulian ifmr->ifm_active |= IFM_HDX; 161693746Sjulian 161793746Sjulian MY_UNLOCK(sc); 161893746Sjulian return; 161993746Sjulian } 162093746Sjulian ability = my_phy_readreg(sc, PHY_LPAR); 162193746Sjulian advert = my_phy_readreg(sc, PHY_ANAR); 162293746Sjulian 162394863Sjulian#if 0 /* this version did not support 1000M, */ 162493746Sjulian if (sc->my_pinfo->my_vid = MarvellPHYID0) { 162593746Sjulian ability2 = my_phy_readreg(sc, PHY_1000SR); 162693746Sjulian if (ability2 & PHY_1000SR_1000BTXFULL) { 162793746Sjulian advert = 0; 162893746Sjulian ability = 0; 162995673Sphk ifmr->ifm_active = IFM_ETHER|IFM_1000_T|IFM_FDX; 163093746Sjulian } else if (ability & PHY_1000SR_1000BTXHALF) { 163193746Sjulian advert = 0; 163293746Sjulian ability = 0; 163395673Sphk ifmr->ifm_active = IFM_ETHER|IFM_1000_T|IFM_HDX; 163493746Sjulian } 163593746Sjulian } 163693746Sjulian#endif 163793746Sjulian if (advert & PHY_ANAR_100BT4 && ability & PHY_ANAR_100BT4) 163893746Sjulian ifmr->ifm_active = IFM_ETHER | IFM_100_T4; 163993746Sjulian else if (advert & PHY_ANAR_100BTXFULL && ability & PHY_ANAR_100BTXFULL) 164093746Sjulian ifmr->ifm_active = IFM_ETHER | IFM_100_TX | IFM_FDX; 164193746Sjulian else if (advert & PHY_ANAR_100BTXHALF && ability & PHY_ANAR_100BTXHALF) 164293746Sjulian ifmr->ifm_active = IFM_ETHER | IFM_100_TX | IFM_HDX; 164393746Sjulian else if (advert & PHY_ANAR_10BTFULL && ability & PHY_ANAR_10BTFULL) 164493746Sjulian ifmr->ifm_active = IFM_ETHER | IFM_10_T | IFM_FDX; 164593746Sjulian else if (advert & PHY_ANAR_10BTHALF && ability & PHY_ANAR_10BTHALF) 164693746Sjulian ifmr->ifm_active = IFM_ETHER | IFM_10_T | IFM_HDX; 164793746Sjulian MY_UNLOCK(sc); 164893746Sjulian return; 164993746Sjulian} 165093746Sjulian 165193746Sjulianstatic int 165293746Sjulianmy_ioctl(struct ifnet * ifp, u_long command, caddr_t data) 165393746Sjulian{ 165493746Sjulian struct my_softc *sc = ifp->if_softc; 165593746Sjulian struct ifreq *ifr = (struct ifreq *) data; 165693746Sjulian int s, error = 0; 165793746Sjulian 165893746Sjulian s = splimp(); 165993746Sjulian MY_LOCK(sc); 166093746Sjulian switch (command) { 166193746Sjulian case SIOCSIFFLAGS: 166293746Sjulian if (ifp->if_flags & IFF_UP) 166393746Sjulian my_init(sc); 1664148887Srwatson else if (ifp->if_drv_flags & IFF_DRV_RUNNING) 166593746Sjulian my_stop(sc); 166693746Sjulian error = 0; 166793746Sjulian break; 166893746Sjulian case SIOCADDMULTI: 166993746Sjulian case SIOCDELMULTI: 167093746Sjulian my_setmulti(sc); 167193746Sjulian error = 0; 167293746Sjulian break; 167393746Sjulian case SIOCGIFMEDIA: 167493746Sjulian case SIOCSIFMEDIA: 167593746Sjulian error = ifmedia_ioctl(ifp, ifr, &sc->ifmedia, command); 167693746Sjulian break; 167793746Sjulian default: 1678106937Ssam error = ether_ioctl(ifp, command, data); 167993746Sjulian break; 168093746Sjulian } 168193746Sjulian MY_UNLOCK(sc); 168293746Sjulian (void)splx(s); 168393746Sjulian return (error); 168493746Sjulian} 168593746Sjulian 168693746Sjulianstatic void 168793746Sjulianmy_watchdog(struct ifnet * ifp) 168893746Sjulian{ 168993746Sjulian struct my_softc *sc; 169093746Sjulian 169193746Sjulian sc = ifp->if_softc; 169293746Sjulian MY_LOCK(sc); 169393746Sjulian if (sc->my_autoneg) { 169493746Sjulian my_autoneg_mii(sc, MY_FLAG_DELAYTIMEO, 1); 169593746Sjulian MY_UNLOCK(sc); 169693746Sjulian return; 169793746Sjulian } 169893746Sjulian ifp->if_oerrors++; 1699148945Sjhb if_printf(ifp, "watchdog timeout\n"); 170093746Sjulian if (!(my_phy_readreg(sc, PHY_BMSR) & PHY_BMSR_LINKSTAT)) 1701148945Sjhb if_printf(ifp, "no carrier - transceiver cable problem?\n"); 170293746Sjulian my_stop(sc); 170393746Sjulian my_reset(sc); 170493746Sjulian my_init(sc); 170593746Sjulian if (ifp->if_snd.ifq_head != NULL) 170693746Sjulian my_start(ifp); 170793746Sjulian MY_LOCK(sc); 170893746Sjulian return; 170993746Sjulian} 171093746Sjulian 171193746Sjulian 171293746Sjulian/* 171393746Sjulian * Stop the adapter and free any mbufs allocated to the RX and TX lists. 171493746Sjulian */ 171593746Sjulianstatic void 171693746Sjulianmy_stop(struct my_softc * sc) 171793746Sjulian{ 171893746Sjulian register int i; 171993746Sjulian struct ifnet *ifp; 172093746Sjulian 172193746Sjulian MY_LOCK(sc); 1722147256Sbrooks ifp = sc->my_ifp; 172393746Sjulian ifp->if_timer = 0; 172493746Sjulian 172593746Sjulian MY_CLRBIT(sc, MY_TCRRCR, (MY_RE | MY_TE)); 172693746Sjulian CSR_WRITE_4(sc, MY_IMR, 0x00000000); 172793746Sjulian CSR_WRITE_4(sc, MY_TXLBA, 0x00000000); 172893746Sjulian CSR_WRITE_4(sc, MY_RXLBA, 0x00000000); 172993746Sjulian 173093746Sjulian /* 173193746Sjulian * Free data in the RX lists. 173293746Sjulian */ 173393746Sjulian for (i = 0; i < MY_RX_LIST_CNT; i++) { 173493746Sjulian if (sc->my_cdata.my_rx_chain[i].my_mbuf != NULL) { 173593746Sjulian m_freem(sc->my_cdata.my_rx_chain[i].my_mbuf); 173693746Sjulian sc->my_cdata.my_rx_chain[i].my_mbuf = NULL; 173793746Sjulian } 173893746Sjulian } 173993746Sjulian bzero((char *)&sc->my_ldata->my_rx_list, 174093746Sjulian sizeof(sc->my_ldata->my_rx_list)); 174193746Sjulian /* 174293746Sjulian * Free the TX list buffers. 174393746Sjulian */ 174493746Sjulian for (i = 0; i < MY_TX_LIST_CNT; i++) { 174593746Sjulian if (sc->my_cdata.my_tx_chain[i].my_mbuf != NULL) { 174693746Sjulian m_freem(sc->my_cdata.my_tx_chain[i].my_mbuf); 174793746Sjulian sc->my_cdata.my_tx_chain[i].my_mbuf = NULL; 174893746Sjulian } 174993746Sjulian } 175093746Sjulian bzero((char *)&sc->my_ldata->my_tx_list, 175193746Sjulian sizeof(sc->my_ldata->my_tx_list)); 1752148887Srwatson ifp->if_drv_flags &= ~(IFF_DRV_RUNNING | IFF_DRV_OACTIVE); 175393746Sjulian MY_UNLOCK(sc); 175493746Sjulian return; 175593746Sjulian} 175693746Sjulian 175793746Sjulian/* 175893746Sjulian * Stop all chip I/O so that the kernel's probe routines don't get confused 175993746Sjulian * by errant DMAs when rebooting. 176093746Sjulian */ 176193746Sjulianstatic void 176293746Sjulianmy_shutdown(device_t dev) 176393746Sjulian{ 176493746Sjulian struct my_softc *sc; 176593746Sjulian 176693746Sjulian sc = device_get_softc(dev); 176793746Sjulian my_stop(sc); 176893746Sjulian return; 176993746Sjulian} 1770