1694c6518SBenno Rice /*- 2269a0696SBenno Rice * Copyright (c) 2008 Benno Rice. All rights reserved. 3694c6518SBenno Rice * 4694c6518SBenno Rice * Redistribution and use in source and binary forms, with or without 5694c6518SBenno Rice * modification, are permitted provided that the following conditions 6694c6518SBenno Rice * are met: 7694c6518SBenno Rice * 1. Redistributions of source code must retain the above copyright 8694c6518SBenno Rice * notice, this list of conditions and the following disclaimer. 9694c6518SBenno Rice * 2. Redistributions in binary form must reproduce the above copyright 10694c6518SBenno Rice * notice, this list of conditions and the following disclaimer in the 11694c6518SBenno Rice * documentation and/or other materials provided with the distribution. 12694c6518SBenno Rice * 13694c6518SBenno Rice * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR 14694c6518SBenno Rice * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES 15694c6518SBenno Rice * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. 16694c6518SBenno Rice * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT, 17694c6518SBenno Rice * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT 18694c6518SBenno Rice * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, 19694c6518SBenno Rice * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY 20694c6518SBenno Rice * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT 21694c6518SBenno Rice * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF 22694c6518SBenno Rice * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. 23694c6518SBenno Rice */ 24694c6518SBenno Rice 25694c6518SBenno Rice #include <sys/cdefs.h> 26694c6518SBenno Rice __FBSDID("$FreeBSD$"); 27694c6518SBenno Rice 28694c6518SBenno Rice /* 29694c6518SBenno Rice * Driver for SMSC LAN91C111, may work for older variants. 30694c6518SBenno Rice */ 31694c6518SBenno Rice 32694c6518SBenno Rice #ifdef HAVE_KERNEL_OPTION_HEADERS 33694c6518SBenno Rice #include "opt_device_polling.h" 34694c6518SBenno Rice #endif 35694c6518SBenno Rice 36694c6518SBenno Rice #include <sys/param.h> 37694c6518SBenno Rice #include <sys/systm.h> 38694c6518SBenno Rice #include <sys/errno.h> 39694c6518SBenno Rice #include <sys/kernel.h> 40694c6518SBenno Rice #include <sys/sockio.h> 41694c6518SBenno Rice #include <sys/malloc.h> 42694c6518SBenno Rice #include <sys/mbuf.h> 43694c6518SBenno Rice #include <sys/queue.h> 44694c6518SBenno Rice #include <sys/socket.h> 45694c6518SBenno Rice #include <sys/syslog.h> 46694c6518SBenno Rice #include <sys/taskqueue.h> 47694c6518SBenno Rice 48694c6518SBenno Rice #include <sys/module.h> 49694c6518SBenno Rice #include <sys/bus.h> 50694c6518SBenno Rice 51694c6518SBenno Rice #include <machine/bus.h> 52694c6518SBenno Rice #include <machine/resource.h> 53694c6518SBenno Rice #include <sys/rman.h> 54694c6518SBenno Rice 55694c6518SBenno Rice #include <net/ethernet.h> 56694c6518SBenno Rice #include <net/if.h> 57694c6518SBenno Rice #include <net/if_arp.h> 58694c6518SBenno Rice #include <net/if_dl.h> 59694c6518SBenno Rice #include <net/if_types.h> 60694c6518SBenno Rice #include <net/if_mib.h> 61694c6518SBenno Rice #include <net/if_media.h> 62694c6518SBenno Rice 63694c6518SBenno Rice #ifdef INET 64694c6518SBenno Rice #include <netinet/in.h> 65694c6518SBenno Rice #include <netinet/in_systm.h> 66694c6518SBenno Rice #include <netinet/in_var.h> 67694c6518SBenno Rice #include <netinet/ip.h> 68694c6518SBenno Rice #endif 69694c6518SBenno Rice 70694c6518SBenno Rice #include <net/bpf.h> 71694c6518SBenno Rice #include <net/bpfdesc.h> 72694c6518SBenno Rice 73694c6518SBenno Rice #include <dev/smc/if_smcreg.h> 74694c6518SBenno Rice #include <dev/smc/if_smcvar.h> 75694c6518SBenno Rice 76694c6518SBenno Rice #include <dev/mii/mii.h> 77694c6518SBenno Rice #include <dev/mii/miivar.h> 78694c6518SBenno Rice 79694c6518SBenno Rice devclass_t smc_devclass; 80694c6518SBenno Rice 81694c6518SBenno Rice static const char *smc_chip_ids[16] = { 82694c6518SBenno Rice NULL, NULL, NULL, 83694c6518SBenno Rice /* 3 */ "SMSC LAN91C90 or LAN91C92", 84694c6518SBenno Rice /* 4 */ "SMSC LAN91C94", 85694c6518SBenno Rice /* 5 */ "SMSC LAN91C95", 86694c6518SBenno Rice /* 6 */ "SMSC LAN91C96", 87694c6518SBenno Rice /* 7 */ "SMSC LAN91C100", 88694c6518SBenno Rice /* 8 */ "SMSC LAN91C100FD", 89694c6518SBenno Rice /* 9 */ "SMSC LAN91C110FD or LAN91C111FD", 90694c6518SBenno Rice NULL, NULL, NULL, 91694c6518SBenno Rice NULL, NULL, NULL 92694c6518SBenno Rice }; 93694c6518SBenno Rice 94694c6518SBenno Rice static void smc_init(void *); 95694c6518SBenno Rice static void smc_start(struct ifnet *); 96694c6518SBenno Rice static int smc_ioctl(struct ifnet *, u_long, caddr_t); 97694c6518SBenno Rice 98694c6518SBenno Rice static void smc_init_locked(struct smc_softc *); 99694c6518SBenno Rice static void smc_start_locked(struct ifnet *); 100694c6518SBenno Rice static void smc_reset(struct smc_softc *); 101694c6518SBenno Rice static int smc_mii_ifmedia_upd(struct ifnet *); 102694c6518SBenno Rice static void smc_mii_ifmedia_sts(struct ifnet *, struct ifmediareq *); 103694c6518SBenno Rice static void smc_mii_tick(void *); 104694c6518SBenno Rice static void smc_mii_mediachg(struct smc_softc *); 105694c6518SBenno Rice static int smc_mii_mediaioctl(struct smc_softc *, struct ifreq *, u_long); 106694c6518SBenno Rice 107694c6518SBenno Rice static void smc_task_rx(void *, int); 108694c6518SBenno Rice static void smc_task_tx(void *, int); 109694c6518SBenno Rice 110694c6518SBenno Rice static driver_filter_t smc_intr; 111694c6518SBenno Rice static timeout_t smc_watchdog; 112694c6518SBenno Rice #ifdef DEVICE_POLLING 113694c6518SBenno Rice static poll_handler_t smc_poll; 114694c6518SBenno Rice #endif 115694c6518SBenno Rice 116694c6518SBenno Rice static __inline void 117694c6518SBenno Rice smc_select_bank(struct smc_softc *sc, uint16_t bank) 118694c6518SBenno Rice { 119694c6518SBenno Rice 120269a0696SBenno Rice bus_write_2(sc->smc_reg, BSR, bank & BSR_BANK_MASK); 121694c6518SBenno Rice } 122694c6518SBenno Rice 123694c6518SBenno Rice /* Never call this when not in bank 2. */ 124694c6518SBenno Rice static __inline void 125694c6518SBenno Rice smc_mmu_wait(struct smc_softc *sc) 126694c6518SBenno Rice { 127694c6518SBenno Rice 128269a0696SBenno Rice KASSERT((bus_read_2(sc->smc_reg, BSR) & 129694c6518SBenno Rice BSR_BANK_MASK) == 2, ("%s: smc_mmu_wait called when not in bank 2", 130694c6518SBenno Rice device_get_nameunit(sc->smc_dev))); 131269a0696SBenno Rice while (bus_read_2(sc->smc_reg, MMUCR) & MMUCR_BUSY) 132694c6518SBenno Rice ; 133694c6518SBenno Rice } 134694c6518SBenno Rice 135694c6518SBenno Rice static __inline uint8_t 136694c6518SBenno Rice smc_read_1(struct smc_softc *sc, bus_addr_t offset) 137694c6518SBenno Rice { 138694c6518SBenno Rice 139269a0696SBenno Rice return (bus_read_1(sc->smc_reg, offset)); 140694c6518SBenno Rice } 141694c6518SBenno Rice 142694c6518SBenno Rice static __inline void 143694c6518SBenno Rice smc_write_1(struct smc_softc *sc, bus_addr_t offset, uint8_t val) 144694c6518SBenno Rice { 145694c6518SBenno Rice 146269a0696SBenno Rice bus_write_1(sc->smc_reg, offset, val); 147694c6518SBenno Rice } 148694c6518SBenno Rice 149694c6518SBenno Rice static __inline uint16_t 150694c6518SBenno Rice smc_read_2(struct smc_softc *sc, bus_addr_t offset) 151694c6518SBenno Rice { 152694c6518SBenno Rice 153269a0696SBenno Rice return (bus_read_2(sc->smc_reg, offset)); 154694c6518SBenno Rice } 155694c6518SBenno Rice 156694c6518SBenno Rice static __inline void 157694c6518SBenno Rice smc_write_2(struct smc_softc *sc, bus_addr_t offset, uint16_t val) 158694c6518SBenno Rice { 159694c6518SBenno Rice 160269a0696SBenno Rice bus_write_2(sc->smc_reg, offset, val); 161694c6518SBenno Rice } 162694c6518SBenno Rice 163694c6518SBenno Rice static __inline void 164694c6518SBenno Rice smc_read_multi_2(struct smc_softc *sc, bus_addr_t offset, uint16_t *datap, 165694c6518SBenno Rice bus_size_t count) 166694c6518SBenno Rice { 167694c6518SBenno Rice 168269a0696SBenno Rice bus_read_multi_2(sc->smc_reg, offset, datap, count); 169694c6518SBenno Rice } 170694c6518SBenno Rice 171694c6518SBenno Rice static __inline void 172694c6518SBenno Rice smc_write_multi_2(struct smc_softc *sc, bus_addr_t offset, uint16_t *datap, 173694c6518SBenno Rice bus_size_t count) 174694c6518SBenno Rice { 175694c6518SBenno Rice 176269a0696SBenno Rice bus_write_multi_2(sc->smc_reg, offset, datap, count); 177694c6518SBenno Rice } 178694c6518SBenno Rice 179694c6518SBenno Rice int 180694c6518SBenno Rice smc_probe(device_t dev) 181694c6518SBenno Rice { 182694c6518SBenno Rice int rid, type, error; 183694c6518SBenno Rice uint16_t val; 184694c6518SBenno Rice struct smc_softc *sc; 185694c6518SBenno Rice struct resource *reg; 186694c6518SBenno Rice 187694c6518SBenno Rice sc = device_get_softc(dev); 188694c6518SBenno Rice rid = 0; 189694c6518SBenno Rice type = SYS_RES_IOPORT; 190694c6518SBenno Rice error = 0; 191694c6518SBenno Rice 192694c6518SBenno Rice if (sc->smc_usemem) 193694c6518SBenno Rice type = SYS_RES_MEMORY; 194694c6518SBenno Rice 195694c6518SBenno Rice reg = bus_alloc_resource(dev, type, &rid, 0, ~0, 16, RF_ACTIVE); 196694c6518SBenno Rice if (reg == NULL) { 197694c6518SBenno Rice if (bootverbose) 198694c6518SBenno Rice device_printf(dev, 199694c6518SBenno Rice "could not allocate I/O resource for probe\n"); 200694c6518SBenno Rice return (ENXIO); 201694c6518SBenno Rice } 202694c6518SBenno Rice 203694c6518SBenno Rice /* Check for the identification value in the BSR. */ 204269a0696SBenno Rice val = bus_read_2(reg, BSR); 205694c6518SBenno Rice if ((val & BSR_IDENTIFY_MASK) != BSR_IDENTIFY) { 206694c6518SBenno Rice if (bootverbose) 207694c6518SBenno Rice device_printf(dev, "identification value not in BSR\n"); 208694c6518SBenno Rice error = ENXIO; 209694c6518SBenno Rice goto done; 210694c6518SBenno Rice } 211694c6518SBenno Rice 212694c6518SBenno Rice /* 213694c6518SBenno Rice * Try switching banks and make sure we still get the identification 214694c6518SBenno Rice * value. 215694c6518SBenno Rice */ 216269a0696SBenno Rice bus_write_2(reg, BSR, 0); 217269a0696SBenno Rice val = bus_read_2(reg, BSR); 218694c6518SBenno Rice if ((val & BSR_IDENTIFY_MASK) != BSR_IDENTIFY) { 219694c6518SBenno Rice if (bootverbose) 220694c6518SBenno Rice device_printf(dev, 221694c6518SBenno Rice "identification value not in BSR after write\n"); 222694c6518SBenno Rice error = ENXIO; 223694c6518SBenno Rice goto done; 224694c6518SBenno Rice } 225694c6518SBenno Rice 226694c6518SBenno Rice #if 0 227694c6518SBenno Rice /* Check the BAR. */ 228269a0696SBenno Rice bus_write_2(reg, BSR, 1); 229269a0696SBenno Rice val = bus_read_2(reg, BAR); 230694c6518SBenno Rice val = BAR_ADDRESS(val); 231694c6518SBenno Rice if (rman_get_start(reg) != val) { 232694c6518SBenno Rice if (bootverbose) 233694c6518SBenno Rice device_printf(dev, "BAR address %x does not match " 234694c6518SBenno Rice "I/O resource address %lx\n", val, 235694c6518SBenno Rice rman_get_start(reg)); 236694c6518SBenno Rice error = ENXIO; 237694c6518SBenno Rice goto done; 238694c6518SBenno Rice } 239694c6518SBenno Rice #endif 240694c6518SBenno Rice 241694c6518SBenno Rice /* Compare REV against known chip revisions. */ 242269a0696SBenno Rice bus_write_2(reg, BSR, 3); 243269a0696SBenno Rice val = bus_read_2(reg, REV); 244694c6518SBenno Rice val = (val & REV_CHIP_MASK) >> REV_CHIP_SHIFT; 245694c6518SBenno Rice if (smc_chip_ids[val] == NULL) { 246694c6518SBenno Rice if (bootverbose) 247694c6518SBenno Rice device_printf(dev, "Unknown chip revision: %d\n", val); 248694c6518SBenno Rice error = ENXIO; 249694c6518SBenno Rice goto done; 250694c6518SBenno Rice } 251694c6518SBenno Rice 252694c6518SBenno Rice device_set_desc(dev, smc_chip_ids[val]); 253694c6518SBenno Rice 254694c6518SBenno Rice done: 255694c6518SBenno Rice bus_release_resource(dev, type, rid, reg); 256694c6518SBenno Rice return (error); 257694c6518SBenno Rice } 258694c6518SBenno Rice 259694c6518SBenno Rice int 260694c6518SBenno Rice smc_attach(device_t dev) 261694c6518SBenno Rice { 262694c6518SBenno Rice int type, error; 263694c6518SBenno Rice uint16_t val; 264694c6518SBenno Rice u_char eaddr[ETHER_ADDR_LEN]; 265694c6518SBenno Rice struct smc_softc *sc; 266694c6518SBenno Rice struct ifnet *ifp; 267694c6518SBenno Rice 268694c6518SBenno Rice sc = device_get_softc(dev); 269694c6518SBenno Rice error = 0; 270694c6518SBenno Rice 271694c6518SBenno Rice sc->smc_dev = dev; 272694c6518SBenno Rice 273694c6518SBenno Rice /* Set up watchdog callout. */ 274694c6518SBenno Rice callout_init(&sc->smc_watchdog, 1); 275694c6518SBenno Rice 276694c6518SBenno Rice ifp = sc->smc_ifp = if_alloc(IFT_ETHER); 277694c6518SBenno Rice if (ifp == NULL) { 278694c6518SBenno Rice error = ENOSPC; 279694c6518SBenno Rice goto done; 280694c6518SBenno Rice } 281694c6518SBenno Rice 282694c6518SBenno Rice mtx_init(&sc->smc_mtx, device_get_nameunit(dev), NULL, MTX_SPIN); 283694c6518SBenno Rice 284694c6518SBenno Rice type = SYS_RES_IOPORT; 285694c6518SBenno Rice if (sc->smc_usemem) 286694c6518SBenno Rice type = SYS_RES_MEMORY; 287694c6518SBenno Rice 288694c6518SBenno Rice sc->smc_reg_rid = 0; 289694c6518SBenno Rice sc->smc_reg = bus_alloc_resource(dev, type, &sc->smc_reg_rid, 0, ~0, 290694c6518SBenno Rice 16, RF_ACTIVE); 291694c6518SBenno Rice if (sc->smc_reg == NULL) { 292694c6518SBenno Rice error = ENXIO; 293694c6518SBenno Rice goto done; 294694c6518SBenno Rice } 295694c6518SBenno Rice 296694c6518SBenno Rice sc->smc_irq = bus_alloc_resource(dev, SYS_RES_IRQ, &sc->smc_irq_rid, 0, 297694c6518SBenno Rice ~0, 1, RF_ACTIVE | RF_SHAREABLE); 298694c6518SBenno Rice if (sc->smc_irq == NULL) { 299694c6518SBenno Rice error = ENXIO; 300694c6518SBenno Rice goto done; 301694c6518SBenno Rice } 302694c6518SBenno Rice 303694c6518SBenno Rice SMC_LOCK(sc); 304694c6518SBenno Rice smc_reset(sc); 305694c6518SBenno Rice SMC_UNLOCK(sc); 306694c6518SBenno Rice 307694c6518SBenno Rice smc_select_bank(sc, 3); 308694c6518SBenno Rice val = smc_read_2(sc, REV); 309694c6518SBenno Rice sc->smc_chip = (val & REV_CHIP_MASK) >> REV_CHIP_SHIFT; 310694c6518SBenno Rice sc->smc_rev = (val * REV_REV_MASK) >> REV_REV_SHIFT; 311694c6518SBenno Rice if (bootverbose) 312694c6518SBenno Rice device_printf(dev, "revision %x\n", sc->smc_rev); 313694c6518SBenno Rice 314694c6518SBenno Rice callout_init(&sc->smc_mii_tick_ch, 1); 315694c6518SBenno Rice if (sc->smc_chip >= REV_CHIP_91110FD) { 316694c6518SBenno Rice mii_phy_probe(dev, &sc->smc_miibus, smc_mii_ifmedia_upd, 317694c6518SBenno Rice smc_mii_ifmedia_sts); 318694c6518SBenno Rice if (sc->smc_miibus != NULL) { 319694c6518SBenno Rice sc->smc_mii_tick = smc_mii_tick; 320694c6518SBenno Rice sc->smc_mii_mediachg = smc_mii_mediachg; 321694c6518SBenno Rice sc->smc_mii_mediaioctl = smc_mii_mediaioctl; 322694c6518SBenno Rice } 323694c6518SBenno Rice } 324694c6518SBenno Rice 325694c6518SBenno Rice smc_select_bank(sc, 1); 326694c6518SBenno Rice eaddr[0] = smc_read_1(sc, IAR0); 327694c6518SBenno Rice eaddr[1] = smc_read_1(sc, IAR1); 328694c6518SBenno Rice eaddr[2] = smc_read_1(sc, IAR2); 329694c6518SBenno Rice eaddr[3] = smc_read_1(sc, IAR3); 330694c6518SBenno Rice eaddr[4] = smc_read_1(sc, IAR4); 331694c6518SBenno Rice eaddr[5] = smc_read_1(sc, IAR5); 332694c6518SBenno Rice 333694c6518SBenno Rice if_initname(ifp, device_get_name(dev), device_get_unit(dev)); 334694c6518SBenno Rice ifp->if_softc = sc; 335694c6518SBenno Rice ifp->if_flags = IFF_BROADCAST | IFF_SIMPLEX | IFF_MULTICAST; 336694c6518SBenno Rice ifp->if_init = smc_init; 337694c6518SBenno Rice ifp->if_ioctl = smc_ioctl; 338694c6518SBenno Rice ifp->if_start = smc_start; 339694c6518SBenno Rice IFQ_SET_MAXLEN(&ifp->if_snd, IFQ_MAXLEN); 340694c6518SBenno Rice IFQ_SET_READY(&ifp->if_snd); 341694c6518SBenno Rice 342694c6518SBenno Rice ifp->if_capabilities = ifp->if_capenable = 0; 343694c6518SBenno Rice 344694c6518SBenno Rice #ifdef DEVICE_POLLING 345694c6518SBenno Rice ifp->if_capabilities |= IFCAP_POLLING; 346694c6518SBenno Rice #endif 347694c6518SBenno Rice 348694c6518SBenno Rice ether_ifattach(ifp, eaddr); 349694c6518SBenno Rice 350694c6518SBenno Rice /* Set up taskqueue */ 351694c6518SBenno Rice TASK_INIT(&sc->smc_rx, SMC_RX_PRIORITY, smc_task_rx, ifp); 352694c6518SBenno Rice TASK_INIT(&sc->smc_tx, SMC_TX_PRIORITY, smc_task_tx, ifp); 353694c6518SBenno Rice sc->smc_tq = taskqueue_create_fast("smc_taskq", M_NOWAIT, 354694c6518SBenno Rice taskqueue_thread_enqueue, &sc->smc_tq); 355694c6518SBenno Rice taskqueue_start_threads(&sc->smc_tq, 1, PI_NET, "%s taskq", 356694c6518SBenno Rice device_get_nameunit(sc->smc_dev)); 357694c6518SBenno Rice 358694c6518SBenno Rice /* Mask all interrupts. */ 359694c6518SBenno Rice sc->smc_mask = 0; 360694c6518SBenno Rice smc_write_1(sc, MSK, 0); 361694c6518SBenno Rice 362694c6518SBenno Rice /* Wire up interrupt */ 363694c6518SBenno Rice error = bus_setup_intr(dev, sc->smc_irq, 364694c6518SBenno Rice INTR_TYPE_NET|INTR_MPSAFE, smc_intr, NULL, ifp, &sc->smc_ih); 365694c6518SBenno Rice if (error != 0) 366694c6518SBenno Rice goto done; 367694c6518SBenno Rice 368694c6518SBenno Rice done: 369694c6518SBenno Rice if (error != 0) 370694c6518SBenno Rice smc_detach(dev); 371694c6518SBenno Rice return (error); 372694c6518SBenno Rice } 373694c6518SBenno Rice 374694c6518SBenno Rice int 375694c6518SBenno Rice smc_detach(device_t dev) 376694c6518SBenno Rice { 377694c6518SBenno Rice int type; 378694c6518SBenno Rice struct smc_softc *sc; 379694c6518SBenno Rice 380694c6518SBenno Rice sc = device_get_softc(dev); 381694c6518SBenno Rice 382694c6518SBenno Rice callout_stop(&sc->smc_watchdog); 383694c6518SBenno Rice 384694c6518SBenno Rice if (mtx_initialized(&sc->smc_mtx)) 385694c6518SBenno Rice SMC_LOCK(sc); 386694c6518SBenno Rice 387694c6518SBenno Rice #ifdef DEVICE_POLLING 388694c6518SBenno Rice if (sc->smc_ifp->if_capenable & IFCAP_POLLING) 389694c6518SBenno Rice ether_poll_deregister(sc->smc_ifp); 390694c6518SBenno Rice #endif 391694c6518SBenno Rice 392694c6518SBenno Rice if (sc->smc_ih != NULL) 393694c6518SBenno Rice bus_teardown_intr(sc->smc_dev, sc->smc_irq, sc->smc_ih); 394694c6518SBenno Rice 395694c6518SBenno Rice if (sc->smc_ifp != NULL) { 396694c6518SBenno Rice ether_ifdetach(sc->smc_ifp); 397694c6518SBenno Rice if_free(sc->smc_ifp); 398694c6518SBenno Rice } 399694c6518SBenno Rice 400694c6518SBenno Rice if (sc->smc_miibus != NULL) { 401694c6518SBenno Rice device_delete_child(sc->smc_dev, sc->smc_miibus); 402694c6518SBenno Rice bus_generic_detach(sc->smc_dev); 403694c6518SBenno Rice } 404694c6518SBenno Rice 405694c6518SBenno Rice if (sc->smc_reg != NULL) { 406694c6518SBenno Rice type = SYS_RES_IOPORT; 407694c6518SBenno Rice if (sc->smc_usemem) 408694c6518SBenno Rice type = SYS_RES_MEMORY; 409694c6518SBenno Rice 410694c6518SBenno Rice bus_release_resource(sc->smc_dev, type, sc->smc_reg_rid, 411694c6518SBenno Rice sc->smc_reg); 412694c6518SBenno Rice } 413694c6518SBenno Rice 414694c6518SBenno Rice if (sc->smc_irq != NULL) 415694c6518SBenno Rice bus_release_resource(sc->smc_dev, SYS_RES_IRQ, sc->smc_irq_rid, 416694c6518SBenno Rice sc->smc_irq); 417694c6518SBenno Rice 418694c6518SBenno Rice if (sc->smc_tq != NULL) 419694c6518SBenno Rice taskqueue_free(sc->smc_tq); 420694c6518SBenno Rice 421694c6518SBenno Rice if (mtx_initialized(&sc->smc_mtx)) 422694c6518SBenno Rice mtx_destroy(&sc->smc_mtx); 423694c6518SBenno Rice 424694c6518SBenno Rice return (0); 425694c6518SBenno Rice } 426694c6518SBenno Rice 427694c6518SBenno Rice static void 428694c6518SBenno Rice smc_start(struct ifnet *ifp) 429694c6518SBenno Rice { 430694c6518SBenno Rice struct smc_softc *sc; 431694c6518SBenno Rice 432694c6518SBenno Rice sc = ifp->if_softc; 433694c6518SBenno Rice SMC_LOCK(sc); 434694c6518SBenno Rice smc_start_locked(ifp); 435694c6518SBenno Rice SMC_UNLOCK(sc); 436694c6518SBenno Rice } 437694c6518SBenno Rice 438694c6518SBenno Rice static void 439694c6518SBenno Rice smc_start_locked(struct ifnet *ifp) 440694c6518SBenno Rice { 441694c6518SBenno Rice struct smc_softc *sc; 442694c6518SBenno Rice struct mbuf *m; 443694c6518SBenno Rice u_int len, npages, spin_count; 444694c6518SBenno Rice 445694c6518SBenno Rice sc = ifp->if_softc; 446694c6518SBenno Rice SMC_ASSERT_LOCKED(sc); 447694c6518SBenno Rice 448694c6518SBenno Rice if (ifp->if_drv_flags & IFF_DRV_OACTIVE) 449694c6518SBenno Rice return; 450694c6518SBenno Rice if (IFQ_IS_EMPTY(&ifp->if_snd)) 451694c6518SBenno Rice return; 452694c6518SBenno Rice 453694c6518SBenno Rice /* 454694c6518SBenno Rice * Grab the next packet. If it's too big, drop it. 455694c6518SBenno Rice */ 456694c6518SBenno Rice SMC_UNLOCK(sc); 457694c6518SBenno Rice IFQ_DRV_DEQUEUE(&ifp->if_snd, m); 458694c6518SBenno Rice SMC_LOCK(sc); 459694c6518SBenno Rice len = m_length(m, NULL); 460694c6518SBenno Rice len += (len & 1); 461694c6518SBenno Rice if (len > ETHER_MAX_LEN - ETHER_CRC_LEN) { 462694c6518SBenno Rice if_printf(ifp, "large packet discarded\n"); 463694c6518SBenno Rice ++ifp->if_oerrors; 464694c6518SBenno Rice m_freem(m); 465694c6518SBenno Rice return; /* XXX readcheck? */ 466694c6518SBenno Rice } 467694c6518SBenno Rice 468694c6518SBenno Rice /* 469694c6518SBenno Rice * Flag that we're busy. 470694c6518SBenno Rice */ 471694c6518SBenno Rice ifp->if_drv_flags |= IFF_DRV_OACTIVE; 472694c6518SBenno Rice sc->smc_pending = m; 473694c6518SBenno Rice 474694c6518SBenno Rice /* 475694c6518SBenno Rice * Work out how many 256 byte "pages" we need. We have to include the 476694c6518SBenno Rice * control data for the packet in this calculation. 477694c6518SBenno Rice */ 478694c6518SBenno Rice npages = (len * PKT_CTRL_DATA_LEN) >> 8; 479694c6518SBenno Rice if (npages == 0) 480694c6518SBenno Rice npages = 1; 481694c6518SBenno Rice 482694c6518SBenno Rice /* 483694c6518SBenno Rice * Request memory. 484694c6518SBenno Rice */ 485694c6518SBenno Rice smc_select_bank(sc, 2); 486694c6518SBenno Rice smc_mmu_wait(sc); 487694c6518SBenno Rice smc_write_2(sc, MMUCR, MMUCR_CMD_TX_ALLOC | npages); 488694c6518SBenno Rice 489694c6518SBenno Rice /* 490694c6518SBenno Rice * Spin briefly to see if the allocation succeeds. 491694c6518SBenno Rice */ 492694c6518SBenno Rice spin_count = TX_ALLOC_WAIT_TIME; 493694c6518SBenno Rice do { 494694c6518SBenno Rice if (smc_read_1(sc, IST) & ALLOC_INT) { 495694c6518SBenno Rice smc_write_1(sc, ACK, ALLOC_INT); 496694c6518SBenno Rice break; 497694c6518SBenno Rice } 498694c6518SBenno Rice } while (--spin_count); 499694c6518SBenno Rice 500694c6518SBenno Rice /* 501694c6518SBenno Rice * If the allocation is taking too long, unmask the alloc interrupt 502694c6518SBenno Rice * and wait. 503694c6518SBenno Rice */ 504694c6518SBenno Rice if (spin_count == 0) { 505694c6518SBenno Rice sc->smc_mask |= ALLOC_INT; 506694c6518SBenno Rice if ((ifp->if_capenable & IFCAP_POLLING) == 0) 507694c6518SBenno Rice smc_write_1(sc, MSK, sc->smc_mask); 508694c6518SBenno Rice return; 509694c6518SBenno Rice } 510694c6518SBenno Rice 511694c6518SBenno Rice taskqueue_enqueue_fast(sc->smc_tq, &sc->smc_tx); 512694c6518SBenno Rice } 513694c6518SBenno Rice 514694c6518SBenno Rice static void 515694c6518SBenno Rice smc_task_tx(void *context, int pending) 516694c6518SBenno Rice { 517694c6518SBenno Rice struct ifnet *ifp; 518694c6518SBenno Rice struct smc_softc *sc; 519694c6518SBenno Rice struct mbuf *m, *m0; 520694c6518SBenno Rice u_int packet, len; 521694c6518SBenno Rice uint8_t *data; 522694c6518SBenno Rice 523694c6518SBenno Rice (void)pending; 524694c6518SBenno Rice ifp = (struct ifnet *)context; 525694c6518SBenno Rice sc = ifp->if_softc; 526694c6518SBenno Rice 527694c6518SBenno Rice SMC_LOCK(sc); 528694c6518SBenno Rice 529694c6518SBenno Rice if (sc->smc_pending == NULL) { 530694c6518SBenno Rice SMC_UNLOCK(sc); 531694c6518SBenno Rice goto next_packet; 532694c6518SBenno Rice } 533694c6518SBenno Rice 534694c6518SBenno Rice m = m0 = sc->smc_pending; 535694c6518SBenno Rice sc->smc_pending = NULL; 536694c6518SBenno Rice smc_select_bank(sc, 2); 537694c6518SBenno Rice 538694c6518SBenno Rice /* 539694c6518SBenno Rice * Check the allocation result. 540694c6518SBenno Rice */ 541694c6518SBenno Rice packet = smc_read_1(sc, ARR); 542694c6518SBenno Rice 543694c6518SBenno Rice /* 544694c6518SBenno Rice * If the allocation failed, requeue the packet and retry. 545694c6518SBenno Rice */ 546694c6518SBenno Rice if (packet & ARR_FAILED) { 547694c6518SBenno Rice IFQ_DRV_PREPEND(&ifp->if_snd, m); 548694c6518SBenno Rice ++ifp->if_oerrors; 549694c6518SBenno Rice ifp->if_drv_flags &= ~IFF_DRV_OACTIVE; 550694c6518SBenno Rice smc_start_locked(ifp); 551694c6518SBenno Rice SMC_UNLOCK(sc); 552694c6518SBenno Rice return; 553694c6518SBenno Rice } 554694c6518SBenno Rice 555694c6518SBenno Rice /* 556694c6518SBenno Rice * Tell the device to write to our packet number. 557694c6518SBenno Rice */ 558694c6518SBenno Rice smc_write_1(sc, PNR, packet); 559694c6518SBenno Rice smc_write_2(sc, PTR, 0 | PTR_AUTO_INCR); 560694c6518SBenno Rice 561694c6518SBenno Rice /* 562694c6518SBenno Rice * Tell the device how long the packet is (including control data). 563694c6518SBenno Rice */ 564694c6518SBenno Rice len = m_length(m, 0); 565694c6518SBenno Rice len += PKT_CTRL_DATA_LEN; 566694c6518SBenno Rice smc_write_2(sc, DATA0, 0); 567694c6518SBenno Rice smc_write_2(sc, DATA0, len); 568694c6518SBenno Rice 569694c6518SBenno Rice /* 570694c6518SBenno Rice * Push the data out to the device. 571694c6518SBenno Rice */ 572694c6518SBenno Rice data = NULL; 573694c6518SBenno Rice for (; m != NULL; m = m->m_next) { 574694c6518SBenno Rice data = mtod(m, uint8_t *); 575694c6518SBenno Rice smc_write_multi_2(sc, DATA0, (uint16_t *)data, m->m_len / 2); 576694c6518SBenno Rice } 577694c6518SBenno Rice 578694c6518SBenno Rice /* 579694c6518SBenno Rice * Push out the control byte and and the odd byte if needed. 580694c6518SBenno Rice */ 581694c6518SBenno Rice if ((len & 1) != 0 && data != NULL) 582694c6518SBenno Rice smc_write_2(sc, DATA0, (CTRL_ODD << 8) | data[m->m_len - 1]); 583694c6518SBenno Rice else 584694c6518SBenno Rice smc_write_2(sc, DATA0, 0); 585694c6518SBenno Rice 586694c6518SBenno Rice /* 587694c6518SBenno Rice * Unmask the TX empty interrupt. 588694c6518SBenno Rice */ 589694c6518SBenno Rice sc->smc_mask |= TX_EMPTY_INT; 590694c6518SBenno Rice if ((ifp->if_capenable & IFCAP_POLLING) == 0) 591694c6518SBenno Rice smc_write_1(sc, MSK, sc->smc_mask); 592694c6518SBenno Rice 593694c6518SBenno Rice /* 594694c6518SBenno Rice * Enqueue the packet. 595694c6518SBenno Rice */ 596694c6518SBenno Rice smc_mmu_wait(sc); 597694c6518SBenno Rice smc_write_2(sc, MMUCR, MMUCR_CMD_ENQUEUE); 598694c6518SBenno Rice callout_reset(&sc->smc_watchdog, hz * 2, smc_watchdog, ifp); 599694c6518SBenno Rice 600694c6518SBenno Rice /* 601694c6518SBenno Rice * Finish up. 602694c6518SBenno Rice */ 603694c6518SBenno Rice ifp->if_opackets++; 604694c6518SBenno Rice ifp->if_drv_flags &= ~IFF_DRV_OACTIVE; 605694c6518SBenno Rice SMC_UNLOCK(sc); 606694c6518SBenno Rice BPF_MTAP(ifp, m0); 607694c6518SBenno Rice m_freem(m0); 608694c6518SBenno Rice 609694c6518SBenno Rice next_packet: 610694c6518SBenno Rice /* 611694c6518SBenno Rice * See if there's anything else to do. 612694c6518SBenno Rice */ 613694c6518SBenno Rice smc_start(ifp); 614694c6518SBenno Rice } 615694c6518SBenno Rice 616694c6518SBenno Rice static void 617694c6518SBenno Rice smc_task_rx(void *context, int pending) 618694c6518SBenno Rice { 619694c6518SBenno Rice u_int packet, status, len; 620694c6518SBenno Rice uint8_t *data; 621694c6518SBenno Rice struct ifnet *ifp; 622694c6518SBenno Rice struct smc_softc *sc; 623694c6518SBenno Rice struct mbuf *m, *mhead, *mtail; 624694c6518SBenno Rice 625694c6518SBenno Rice (void)pending; 626694c6518SBenno Rice ifp = (struct ifnet *)context; 627694c6518SBenno Rice sc = ifp->if_softc; 628694c6518SBenno Rice mhead = mtail = NULL; 629694c6518SBenno Rice 630694c6518SBenno Rice SMC_LOCK(sc); 631694c6518SBenno Rice 632694c6518SBenno Rice packet = smc_read_1(sc, FIFO_RX); 633694c6518SBenno Rice while ((packet & FIFO_EMPTY) == 0) { 634694c6518SBenno Rice /* 635694c6518SBenno Rice * Grab an mbuf and attach a cluster. 636694c6518SBenno Rice */ 637694c6518SBenno Rice MGETHDR(m, M_DONTWAIT, MT_DATA); 638694c6518SBenno Rice if (m == NULL) { 639694c6518SBenno Rice break; 640694c6518SBenno Rice } 641694c6518SBenno Rice MCLGET(m, M_DONTWAIT); 642694c6518SBenno Rice if ((m->m_flags & M_EXT) == 0) { 643694c6518SBenno Rice m_freem(m); 644694c6518SBenno Rice break; 645694c6518SBenno Rice } 646694c6518SBenno Rice 647694c6518SBenno Rice /* 648694c6518SBenno Rice * Point to the start of the packet. 649694c6518SBenno Rice */ 650694c6518SBenno Rice smc_select_bank(sc, 2); 651694c6518SBenno Rice smc_write_1(sc, PNR, packet); 652694c6518SBenno Rice smc_write_2(sc, PTR, 0 | PTR_READ | PTR_RCV | PTR_AUTO_INCR); 653694c6518SBenno Rice 654694c6518SBenno Rice /* 655694c6518SBenno Rice * Grab status and packet length. 656694c6518SBenno Rice */ 657694c6518SBenno Rice status = smc_read_2(sc, DATA0); 658694c6518SBenno Rice len = smc_read_2(sc, DATA0) & RX_LEN_MASK; 659694c6518SBenno Rice len -= 6; 660694c6518SBenno Rice if (status & RX_ODDFRM) 661694c6518SBenno Rice len += 1; 662694c6518SBenno Rice 663694c6518SBenno Rice /* 664694c6518SBenno Rice * Check for errors. 665694c6518SBenno Rice */ 666694c6518SBenno Rice if (status & (RX_TOOSHORT | RX_TOOLNG | RX_BADCRC | RX_ALGNERR)) { 667694c6518SBenno Rice smc_mmu_wait(sc); 668694c6518SBenno Rice smc_write_2(sc, MMUCR, MMUCR_CMD_RELEASE); 669694c6518SBenno Rice ifp->if_ierrors++; 670694c6518SBenno Rice m_freem(m); 671694c6518SBenno Rice break; 672694c6518SBenno Rice } 673694c6518SBenno Rice 674694c6518SBenno Rice /* 675694c6518SBenno Rice * Set the mbuf up the way we want it. 676694c6518SBenno Rice */ 677694c6518SBenno Rice m->m_pkthdr.rcvif = ifp; 678694c6518SBenno Rice m->m_pkthdr.len = m->m_len = len + 2; /* XXX: Is this right? */ 679694c6518SBenno Rice m_adj(m, ETHER_ALIGN); 680694c6518SBenno Rice 681694c6518SBenno Rice /* 682694c6518SBenno Rice * Pull the packet out of the device. Make sure we're in the 683694c6518SBenno Rice * right bank first as things may have changed while we were 684694c6518SBenno Rice * allocating our mbuf. 685694c6518SBenno Rice */ 686694c6518SBenno Rice smc_select_bank(sc, 2); 687694c6518SBenno Rice smc_write_1(sc, PNR, packet); 688694c6518SBenno Rice smc_write_2(sc, PTR, 4 | PTR_READ | PTR_RCV | PTR_AUTO_INCR); 689694c6518SBenno Rice data = mtod(m, uint8_t *); 690694c6518SBenno Rice smc_read_multi_2(sc, DATA0, (uint16_t *)data, len >> 1); 691694c6518SBenno Rice if (len & 1) { 692694c6518SBenno Rice data += len & ~1; 693694c6518SBenno Rice *data = smc_read_1(sc, DATA0); 694694c6518SBenno Rice } 695694c6518SBenno Rice 696694c6518SBenno Rice /* 697694c6518SBenno Rice * Tell the device we're done. 698694c6518SBenno Rice */ 699694c6518SBenno Rice smc_mmu_wait(sc); 700694c6518SBenno Rice smc_write_2(sc, MMUCR, MMUCR_CMD_RELEASE); 701694c6518SBenno Rice if (m == NULL) { 702694c6518SBenno Rice break; 703694c6518SBenno Rice } 704694c6518SBenno Rice 705694c6518SBenno Rice if (mhead == NULL) { 706694c6518SBenno Rice mhead = mtail = m; 707694c6518SBenno Rice m->m_next = NULL; 708694c6518SBenno Rice } else { 709694c6518SBenno Rice mtail->m_next = m; 710694c6518SBenno Rice mtail = m; 711694c6518SBenno Rice } 712694c6518SBenno Rice packet = smc_read_1(sc, FIFO_RX); 713694c6518SBenno Rice } 714694c6518SBenno Rice 715694c6518SBenno Rice sc->smc_mask |= RCV_INT; 716694c6518SBenno Rice if ((ifp->if_capenable & IFCAP_POLLING) == 0) 717694c6518SBenno Rice smc_write_1(sc, MSK, sc->smc_mask); 718694c6518SBenno Rice 719694c6518SBenno Rice SMC_UNLOCK(sc); 720694c6518SBenno Rice 721694c6518SBenno Rice while (mhead != NULL) { 722694c6518SBenno Rice m = mhead; 723694c6518SBenno Rice mhead = mhead->m_next; 724694c6518SBenno Rice m->m_next = NULL; 725694c6518SBenno Rice ifp->if_ipackets++; 726694c6518SBenno Rice (*ifp->if_input)(ifp, m); 727694c6518SBenno Rice } 728694c6518SBenno Rice } 729694c6518SBenno Rice 730694c6518SBenno Rice #ifdef DEVICE_POLLING 731694c6518SBenno Rice static void 732694c6518SBenno Rice smc_poll(struct ifnet *ifp, enum poll_cmd cmd, int count) 733694c6518SBenno Rice { 734694c6518SBenno Rice struct smc_softc *sc; 735694c6518SBenno Rice 736694c6518SBenno Rice sc = ifp->if_softc; 737694c6518SBenno Rice 738694c6518SBenno Rice SMC_LOCK(sc); 739694c6518SBenno Rice if ((ifp->if_drv_flags & IFF_DRV_RUNNING) == 0) { 740694c6518SBenno Rice SMC_UNLOCK(sc); 741694c6518SBenno Rice return; 742694c6518SBenno Rice } 743694c6518SBenno Rice SMC_UNLOCK(sc); 744694c6518SBenno Rice 745694c6518SBenno Rice if (cmd == POLL_AND_CHECK_STATUS) 746694c6518SBenno Rice smc_intr(ifp); 747694c6518SBenno Rice } 748694c6518SBenno Rice #endif 749694c6518SBenno Rice 750694c6518SBenno Rice static int 751694c6518SBenno Rice smc_intr(void *context) 752694c6518SBenno Rice { 753694c6518SBenno Rice struct smc_softc *sc; 754694c6518SBenno Rice struct ifnet *ifp; 755694c6518SBenno Rice u_int status, packet, counter, tcr; 756694c6518SBenno Rice 757694c6518SBenno Rice ifp = (struct ifnet *)context; 758694c6518SBenno Rice sc = ifp->if_softc; 759694c6518SBenno Rice 760694c6518SBenno Rice SMC_LOCK(sc); 761694c6518SBenno Rice smc_select_bank(sc, 2); 762694c6518SBenno Rice 763694c6518SBenno Rice /* 764694c6518SBenno Rice * Get the current mask, and then block all interrupts while we're 765694c6518SBenno Rice * working. 766694c6518SBenno Rice */ 767694c6518SBenno Rice if ((ifp->if_capenable & IFCAP_POLLING) == 0) 768694c6518SBenno Rice smc_write_1(sc, MSK, 0); 769694c6518SBenno Rice 770694c6518SBenno Rice /* 771694c6518SBenno Rice * Find out what interrupts are flagged. 772694c6518SBenno Rice */ 773694c6518SBenno Rice status = smc_read_1(sc, IST) & sc->smc_mask; 774694c6518SBenno Rice 775694c6518SBenno Rice /* 776694c6518SBenno Rice * Transmit error 777694c6518SBenno Rice */ 778694c6518SBenno Rice if (status & TX_INT) { 779694c6518SBenno Rice /* 780694c6518SBenno Rice * Kill off the packet if there is one and re-enable transmit. 781694c6518SBenno Rice */ 782694c6518SBenno Rice packet = smc_read_1(sc, FIFO_TX); 783694c6518SBenno Rice if ((packet & FIFO_EMPTY) == 0) { 784694c6518SBenno Rice smc_write_1(sc, PNR, packet); 785694c6518SBenno Rice smc_write_2(sc, PTR, 0 | PTR_READ | 786694c6518SBenno Rice PTR_AUTO_INCR); 787694c6518SBenno Rice tcr = smc_read_2(sc, DATA0); 788694c6518SBenno Rice if ((tcr & EPHSR_TX_SUC) == 0) 789694c6518SBenno Rice device_printf(sc->smc_dev, 790694c6518SBenno Rice "bad packet\n"); 791694c6518SBenno Rice smc_mmu_wait(sc); 792694c6518SBenno Rice smc_write_2(sc, MMUCR, MMUCR_CMD_RELEASE_PKT); 793694c6518SBenno Rice 794694c6518SBenno Rice smc_select_bank(sc, 0); 795694c6518SBenno Rice tcr = smc_read_2(sc, TCR); 796694c6518SBenno Rice tcr |= TCR_TXENA | TCR_PAD_EN; 797694c6518SBenno Rice smc_write_2(sc, TCR, tcr); 798694c6518SBenno Rice smc_select_bank(sc, 2); 799694c6518SBenno Rice taskqueue_enqueue_fast(sc->smc_tq, &sc->smc_tx); 800694c6518SBenno Rice } 801694c6518SBenno Rice 802694c6518SBenno Rice /* 803694c6518SBenno Rice * Ack the interrupt. 804694c6518SBenno Rice */ 805694c6518SBenno Rice smc_write_1(sc, ACK, TX_INT); 806694c6518SBenno Rice } 807694c6518SBenno Rice 808694c6518SBenno Rice /* 809694c6518SBenno Rice * Receive 810694c6518SBenno Rice */ 811694c6518SBenno Rice if (status & RCV_INT) { 812694c6518SBenno Rice smc_write_1(sc, ACK, RCV_INT); 813694c6518SBenno Rice sc->smc_mask &= ~RCV_INT; 814694c6518SBenno Rice taskqueue_enqueue_fast(sc->smc_tq, &sc->smc_rx); 815694c6518SBenno Rice } 816694c6518SBenno Rice 817694c6518SBenno Rice /* 818694c6518SBenno Rice * Allocation 819694c6518SBenno Rice */ 820694c6518SBenno Rice if (status & ALLOC_INT) { 821694c6518SBenno Rice smc_write_1(sc, ACK, ALLOC_INT); 822694c6518SBenno Rice sc->smc_mask &= ~ALLOC_INT; 823694c6518SBenno Rice taskqueue_enqueue_fast(sc->smc_tq, &sc->smc_tx); 824694c6518SBenno Rice } 825694c6518SBenno Rice 826694c6518SBenno Rice /* 827694c6518SBenno Rice * Receive overrun 828694c6518SBenno Rice */ 829694c6518SBenno Rice if (status & RX_OVRN_INT) { 830694c6518SBenno Rice smc_write_1(sc, ACK, RX_OVRN_INT); 831694c6518SBenno Rice ifp->if_ierrors++; 832694c6518SBenno Rice } 833694c6518SBenno Rice 834694c6518SBenno Rice /* 835694c6518SBenno Rice * Transmit empty 836694c6518SBenno Rice */ 837694c6518SBenno Rice if (status & TX_EMPTY_INT) { 838694c6518SBenno Rice smc_write_1(sc, ACK, TX_EMPTY_INT); 839694c6518SBenno Rice sc->smc_mask &= ~TX_EMPTY_INT; 840694c6518SBenno Rice callout_stop(&sc->smc_watchdog); 841694c6518SBenno Rice 842694c6518SBenno Rice /* 843694c6518SBenno Rice * Update collision stats. 844694c6518SBenno Rice */ 845694c6518SBenno Rice smc_select_bank(sc, 0); 846694c6518SBenno Rice counter = smc_read_2(sc, ECR); 847694c6518SBenno Rice smc_select_bank(sc, 2); 848694c6518SBenno Rice ifp->if_collisions += 849694c6518SBenno Rice (counter & ECR_SNGLCOL_MASK) >> ECR_SNGLCOL_SHIFT; 850694c6518SBenno Rice ifp->if_collisions += 851694c6518SBenno Rice (counter & ECR_MULCOL_MASK) >> ECR_MULCOL_SHIFT; 852694c6518SBenno Rice 853694c6518SBenno Rice /* 854694c6518SBenno Rice * See if there are any packets to transmit. 855694c6518SBenno Rice */ 856694c6518SBenno Rice taskqueue_enqueue_fast(sc->smc_tq, &sc->smc_tx); 857694c6518SBenno Rice } 858694c6518SBenno Rice 859694c6518SBenno Rice /* 860694c6518SBenno Rice * Update the interrupt mask. 861694c6518SBenno Rice */ 862694c6518SBenno Rice if ((ifp->if_capenable & IFCAP_POLLING) == 0) 863694c6518SBenno Rice smc_write_1(sc, MSK, sc->smc_mask); 864694c6518SBenno Rice 865694c6518SBenno Rice SMC_UNLOCK(sc); 866694c6518SBenno Rice 867694c6518SBenno Rice return (FILTER_HANDLED); 868694c6518SBenno Rice } 869694c6518SBenno Rice 870694c6518SBenno Rice static u_int 871694c6518SBenno Rice smc_mii_readbits(struct smc_softc *sc, int nbits) 872694c6518SBenno Rice { 873694c6518SBenno Rice u_int mgmt, mask, val; 874694c6518SBenno Rice 875694c6518SBenno Rice SMC_ASSERT_LOCKED(sc); 876694c6518SBenno Rice KASSERT((smc_read_2(sc, BSR) & BSR_BANK_MASK) == 3, 877694c6518SBenno Rice ("%s: smc_mii_readbits called with bank %d (!= 3)", 878694c6518SBenno Rice device_get_nameunit(sc->smc_dev), 879694c6518SBenno Rice smc_read_2(sc, BSR) & BSR_BANK_MASK)); 880694c6518SBenno Rice 881694c6518SBenno Rice /* 882694c6518SBenno Rice * Set up the MGMT (aka MII) register. 883694c6518SBenno Rice */ 884694c6518SBenno Rice mgmt = smc_read_2(sc, MGMT) & ~(MGMT_MCLK | MGMT_MDOE | MGMT_MDO); 885694c6518SBenno Rice smc_write_2(sc, MGMT, mgmt); 886694c6518SBenno Rice 887694c6518SBenno Rice /* 888694c6518SBenno Rice * Read the bits in. 889694c6518SBenno Rice */ 890694c6518SBenno Rice for (mask = 1 << (nbits - 1), val = 0; mask; mask >>= 1) { 891694c6518SBenno Rice if (smc_read_2(sc, MGMT) & MGMT_MDI) 892694c6518SBenno Rice val |= mask; 893694c6518SBenno Rice 894694c6518SBenno Rice smc_write_2(sc, MGMT, mgmt); 895694c6518SBenno Rice DELAY(1); 896694c6518SBenno Rice smc_write_2(sc, MGMT, mgmt | MGMT_MCLK); 897694c6518SBenno Rice DELAY(1); 898694c6518SBenno Rice } 899694c6518SBenno Rice 900694c6518SBenno Rice return (val); 901694c6518SBenno Rice } 902694c6518SBenno Rice 903694c6518SBenno Rice static void 904694c6518SBenno Rice smc_mii_writebits(struct smc_softc *sc, u_int val, int nbits) 905694c6518SBenno Rice { 906694c6518SBenno Rice u_int mgmt, mask; 907694c6518SBenno Rice 908694c6518SBenno Rice SMC_ASSERT_LOCKED(sc); 909694c6518SBenno Rice KASSERT((smc_read_2(sc, BSR) & BSR_BANK_MASK) == 3, 910694c6518SBenno Rice ("%s: smc_mii_writebits called with bank %d (!= 3)", 911694c6518SBenno Rice device_get_nameunit(sc->smc_dev), 912694c6518SBenno Rice smc_read_2(sc, BSR) & BSR_BANK_MASK)); 913694c6518SBenno Rice 914694c6518SBenno Rice /* 915694c6518SBenno Rice * Set up the MGMT (aka MII) register). 916694c6518SBenno Rice */ 917694c6518SBenno Rice mgmt = smc_read_2(sc, MGMT) & ~(MGMT_MCLK | MGMT_MDOE | MGMT_MDO); 918694c6518SBenno Rice mgmt |= MGMT_MDOE; 919694c6518SBenno Rice 920694c6518SBenno Rice /* 921694c6518SBenno Rice * Push the bits out. 922694c6518SBenno Rice */ 923694c6518SBenno Rice for (mask = 1 << (nbits - 1); mask; mask >>= 1) { 924694c6518SBenno Rice if (val & mask) 925694c6518SBenno Rice mgmt |= MGMT_MDO; 926694c6518SBenno Rice else 927694c6518SBenno Rice mgmt &= ~MGMT_MDO; 928694c6518SBenno Rice 929694c6518SBenno Rice smc_write_2(sc, MGMT, mgmt); 930694c6518SBenno Rice DELAY(1); 931694c6518SBenno Rice smc_write_2(sc, MGMT, mgmt | MGMT_MCLK); 932694c6518SBenno Rice DELAY(1); 933694c6518SBenno Rice } 934694c6518SBenno Rice } 935694c6518SBenno Rice 936694c6518SBenno Rice int 937694c6518SBenno Rice smc_miibus_readreg(device_t dev, int phy, int reg) 938694c6518SBenno Rice { 939694c6518SBenno Rice struct smc_softc *sc; 940694c6518SBenno Rice int val; 941694c6518SBenno Rice 942694c6518SBenno Rice sc = device_get_softc(dev); 943694c6518SBenno Rice 944694c6518SBenno Rice SMC_LOCK(sc); 945694c6518SBenno Rice 946694c6518SBenno Rice smc_select_bank(sc, 3); 947694c6518SBenno Rice 948694c6518SBenno Rice /* 949694c6518SBenno Rice * Send out the idle pattern. 950694c6518SBenno Rice */ 951694c6518SBenno Rice smc_mii_writebits(sc, 0xffffffff, 32); 952694c6518SBenno Rice 953694c6518SBenno Rice /* 954694c6518SBenno Rice * Start code + read opcode + phy address + phy register 955694c6518SBenno Rice */ 956694c6518SBenno Rice smc_mii_writebits(sc, 6 << 10 | phy << 5 | reg, 14); 957694c6518SBenno Rice 958694c6518SBenno Rice /* 959694c6518SBenno Rice * Turnaround + data 960694c6518SBenno Rice */ 961694c6518SBenno Rice val = smc_mii_readbits(sc, 18); 962694c6518SBenno Rice 963694c6518SBenno Rice /* 964694c6518SBenno Rice * Reset the MDIO interface. 965694c6518SBenno Rice */ 966694c6518SBenno Rice smc_write_2(sc, MGMT, 967694c6518SBenno Rice smc_read_2(sc, MGMT) & ~(MGMT_MCLK | MGMT_MDOE | MGMT_MDO)); 968694c6518SBenno Rice 969694c6518SBenno Rice SMC_UNLOCK(sc); 970694c6518SBenno Rice return (val); 971694c6518SBenno Rice } 972694c6518SBenno Rice 973694c6518SBenno Rice void 974694c6518SBenno Rice smc_miibus_writereg(device_t dev, int phy, int reg, int data) 975694c6518SBenno Rice { 976694c6518SBenno Rice struct smc_softc *sc; 977694c6518SBenno Rice 978694c6518SBenno Rice sc = device_get_softc(dev); 979694c6518SBenno Rice 980694c6518SBenno Rice SMC_LOCK(sc); 981694c6518SBenno Rice 982694c6518SBenno Rice smc_select_bank(sc, 3); 983694c6518SBenno Rice 984694c6518SBenno Rice /* 985694c6518SBenno Rice * Send idle pattern. 986694c6518SBenno Rice */ 987694c6518SBenno Rice smc_mii_writebits(sc, 0xffffffff, 32); 988694c6518SBenno Rice 989694c6518SBenno Rice /* 990694c6518SBenno Rice * Start code + write opcode + phy address + phy register + turnaround 991694c6518SBenno Rice * + data. 992694c6518SBenno Rice */ 993694c6518SBenno Rice smc_mii_writebits(sc, 5 << 28 | phy << 23 | reg << 18 | 2 << 16 | data, 994694c6518SBenno Rice 32); 995694c6518SBenno Rice 996694c6518SBenno Rice /* 997694c6518SBenno Rice * Reset MDIO interface. 998694c6518SBenno Rice */ 999694c6518SBenno Rice smc_write_2(sc, MGMT, 1000694c6518SBenno Rice smc_read_2(sc, MGMT) & ~(MGMT_MCLK | MGMT_MDOE | MGMT_MDO)); 1001694c6518SBenno Rice 1002694c6518SBenno Rice SMC_UNLOCK(sc); 1003694c6518SBenno Rice } 1004694c6518SBenno Rice 1005694c6518SBenno Rice void 1006694c6518SBenno Rice smc_miibus_statchg(device_t dev) 1007694c6518SBenno Rice { 1008694c6518SBenno Rice struct smc_softc *sc; 1009694c6518SBenno Rice struct mii_data *mii; 1010694c6518SBenno Rice uint16_t tcr; 1011694c6518SBenno Rice 1012694c6518SBenno Rice sc = device_get_softc(dev); 1013694c6518SBenno Rice mii = device_get_softc(sc->smc_miibus); 1014694c6518SBenno Rice 1015694c6518SBenno Rice SMC_LOCK(sc); 1016694c6518SBenno Rice 1017694c6518SBenno Rice smc_select_bank(sc, 0); 1018694c6518SBenno Rice tcr = smc_read_2(sc, TCR); 1019694c6518SBenno Rice 1020694c6518SBenno Rice if ((IFM_OPTIONS(mii->mii_media_active) & IFM_FDX) != 0) 1021694c6518SBenno Rice tcr |= TCR_SWFDUP; 1022694c6518SBenno Rice else 1023694c6518SBenno Rice tcr &= ~TCR_SWFDUP; 1024694c6518SBenno Rice 1025694c6518SBenno Rice smc_write_2(sc, TCR, tcr); 1026694c6518SBenno Rice 1027694c6518SBenno Rice SMC_UNLOCK(sc); 1028694c6518SBenno Rice } 1029694c6518SBenno Rice 1030694c6518SBenno Rice static int 1031694c6518SBenno Rice smc_mii_ifmedia_upd(struct ifnet *ifp) 1032694c6518SBenno Rice { 1033694c6518SBenno Rice struct smc_softc *sc; 1034694c6518SBenno Rice struct mii_data *mii; 1035694c6518SBenno Rice 1036694c6518SBenno Rice sc = ifp->if_softc; 1037694c6518SBenno Rice if (sc->smc_miibus == NULL) 1038694c6518SBenno Rice return (ENXIO); 1039694c6518SBenno Rice 1040694c6518SBenno Rice mii = device_get_softc(sc->smc_miibus); 1041694c6518SBenno Rice return (mii_mediachg(mii)); 1042694c6518SBenno Rice } 1043694c6518SBenno Rice 1044694c6518SBenno Rice static void 1045694c6518SBenno Rice smc_mii_ifmedia_sts(struct ifnet *ifp, struct ifmediareq *ifmr) 1046694c6518SBenno Rice { 1047694c6518SBenno Rice struct smc_softc *sc; 1048694c6518SBenno Rice struct mii_data *mii; 1049694c6518SBenno Rice 1050694c6518SBenno Rice sc = ifp->if_softc; 1051694c6518SBenno Rice if (sc->smc_miibus == NULL) 1052694c6518SBenno Rice return; 1053694c6518SBenno Rice 1054694c6518SBenno Rice mii = device_get_softc(sc->smc_miibus); 1055694c6518SBenno Rice mii_pollstat(mii); 1056694c6518SBenno Rice ifmr->ifm_active = mii->mii_media_active; 1057694c6518SBenno Rice ifmr->ifm_status = mii->mii_media_status; 1058694c6518SBenno Rice } 1059694c6518SBenno Rice 1060694c6518SBenno Rice static void 1061694c6518SBenno Rice smc_mii_tick(void *context) 1062694c6518SBenno Rice { 1063694c6518SBenno Rice struct smc_softc *sc; 1064694c6518SBenno Rice 1065694c6518SBenno Rice sc = (struct smc_softc *)context; 1066694c6518SBenno Rice 1067694c6518SBenno Rice if (sc->smc_miibus == NULL) 1068694c6518SBenno Rice return; 1069694c6518SBenno Rice 1070694c6518SBenno Rice mii_tick(device_get_softc(sc->smc_miibus)); 1071694c6518SBenno Rice callout_reset(&sc->smc_mii_tick_ch, hz, smc_mii_tick, sc); 1072694c6518SBenno Rice } 1073694c6518SBenno Rice 1074694c6518SBenno Rice static void 1075694c6518SBenno Rice smc_mii_mediachg(struct smc_softc *sc) 1076694c6518SBenno Rice { 1077694c6518SBenno Rice 1078694c6518SBenno Rice if (sc->smc_miibus == NULL) 1079694c6518SBenno Rice return; 1080694c6518SBenno Rice mii_mediachg(device_get_softc(sc->smc_miibus)); 1081694c6518SBenno Rice } 1082694c6518SBenno Rice 1083694c6518SBenno Rice static int 1084694c6518SBenno Rice smc_mii_mediaioctl(struct smc_softc *sc, struct ifreq *ifr, u_long command) 1085694c6518SBenno Rice { 1086694c6518SBenno Rice struct mii_data *mii; 1087694c6518SBenno Rice 1088694c6518SBenno Rice if (sc->smc_miibus == NULL) 1089694c6518SBenno Rice return (EINVAL); 1090694c6518SBenno Rice 1091694c6518SBenno Rice mii = device_get_softc(sc->smc_miibus); 1092694c6518SBenno Rice return (ifmedia_ioctl(sc->smc_ifp, ifr, &mii->mii_media, command)); 1093694c6518SBenno Rice } 1094694c6518SBenno Rice 1095694c6518SBenno Rice static void 1096694c6518SBenno Rice smc_reset(struct smc_softc *sc) 1097694c6518SBenno Rice { 1098694c6518SBenno Rice u_int ctr; 1099694c6518SBenno Rice 1100694c6518SBenno Rice SMC_ASSERT_LOCKED(sc); 1101694c6518SBenno Rice 1102694c6518SBenno Rice smc_select_bank(sc, 2); 1103694c6518SBenno Rice 1104694c6518SBenno Rice /* 1105694c6518SBenno Rice * Mask all interrupts. 1106694c6518SBenno Rice */ 1107694c6518SBenno Rice smc_write_1(sc, MSK, 0); 1108694c6518SBenno Rice 1109694c6518SBenno Rice /* 1110694c6518SBenno Rice * Tell the device to reset. 1111694c6518SBenno Rice */ 1112694c6518SBenno Rice smc_select_bank(sc, 0); 1113694c6518SBenno Rice smc_write_2(sc, RCR, RCR_SOFT_RST); 1114694c6518SBenno Rice 1115694c6518SBenno Rice /* 1116694c6518SBenno Rice * Set up the configuration register. 1117694c6518SBenno Rice */ 1118694c6518SBenno Rice smc_select_bank(sc, 1); 1119694c6518SBenno Rice smc_write_2(sc, CR, CR_EPH_POWER_EN); 1120694c6518SBenno Rice DELAY(1); 1121694c6518SBenno Rice 1122694c6518SBenno Rice /* 1123694c6518SBenno Rice * Turn off transmit and receive. 1124694c6518SBenno Rice */ 1125694c6518SBenno Rice smc_select_bank(sc, 0); 1126694c6518SBenno Rice smc_write_2(sc, TCR, 0); 1127694c6518SBenno Rice smc_write_2(sc, RCR, 0); 1128694c6518SBenno Rice 1129694c6518SBenno Rice /* 1130694c6518SBenno Rice * Set up the control register. 1131694c6518SBenno Rice */ 1132694c6518SBenno Rice smc_select_bank(sc, 1); 1133694c6518SBenno Rice ctr = smc_read_2(sc, CTR); 1134694c6518SBenno Rice ctr |= CTR_LE_ENABLE | CTR_AUTO_RELEASE; 1135694c6518SBenno Rice smc_write_2(sc, CTR, ctr); 1136694c6518SBenno Rice 1137694c6518SBenno Rice /* 1138694c6518SBenno Rice * Reset the MMU. 1139694c6518SBenno Rice */ 1140694c6518SBenno Rice smc_select_bank(sc, 2); 1141694c6518SBenno Rice smc_mmu_wait(sc); 1142694c6518SBenno Rice smc_write_2(sc, MMUCR, MMUCR_CMD_MMU_RESET); 1143694c6518SBenno Rice } 1144694c6518SBenno Rice 1145694c6518SBenno Rice static void 1146694c6518SBenno Rice smc_enable(struct smc_softc *sc) 1147694c6518SBenno Rice { 1148694c6518SBenno Rice struct ifnet *ifp; 1149694c6518SBenno Rice 1150694c6518SBenno Rice SMC_ASSERT_LOCKED(sc); 1151694c6518SBenno Rice ifp = sc->smc_ifp; 1152694c6518SBenno Rice 1153694c6518SBenno Rice /* 1154694c6518SBenno Rice * Set up the receive/PHY control register. 1155694c6518SBenno Rice */ 1156694c6518SBenno Rice smc_select_bank(sc, 0); 1157694c6518SBenno Rice smc_write_2(sc, RPCR, RPCR_ANEG | (RPCR_LED_LINK_ANY << RPCR_LSA_SHIFT) 1158694c6518SBenno Rice | (RPCR_LED_ACT_ANY << RPCR_LSB_SHIFT)); 1159694c6518SBenno Rice 1160694c6518SBenno Rice /* 1161694c6518SBenno Rice * Set up the transmit and receive control registers. 1162694c6518SBenno Rice */ 1163694c6518SBenno Rice smc_write_2(sc, TCR, TCR_TXENA | TCR_PAD_EN); 1164694c6518SBenno Rice smc_write_2(sc, RCR, RCR_RXEN | RCR_STRIP_CRC); 1165694c6518SBenno Rice 1166694c6518SBenno Rice /* 1167694c6518SBenno Rice * Set up the interrupt mask. 1168694c6518SBenno Rice */ 1169694c6518SBenno Rice smc_select_bank(sc, 2); 1170694c6518SBenno Rice sc->smc_mask = EPH_INT | RX_OVRN_INT | RCV_INT | TX_INT; 1171694c6518SBenno Rice if ((ifp->if_capenable & IFCAP_POLLING) != 0) 1172694c6518SBenno Rice smc_write_1(sc, MSK, sc->smc_mask); 1173694c6518SBenno Rice } 1174694c6518SBenno Rice 1175694c6518SBenno Rice static void 1176694c6518SBenno Rice smc_stop(struct smc_softc *sc) 1177694c6518SBenno Rice { 1178694c6518SBenno Rice 1179694c6518SBenno Rice SMC_ASSERT_LOCKED(sc); 1180694c6518SBenno Rice 1181694c6518SBenno Rice /* 1182694c6518SBenno Rice * Turn off watchdog. 1183694c6518SBenno Rice */ 1184694c6518SBenno Rice callout_stop(&sc->smc_watchdog); 1185694c6518SBenno Rice 1186694c6518SBenno Rice /* 1187694c6518SBenno Rice * Mask all interrupts. 1188694c6518SBenno Rice */ 1189694c6518SBenno Rice smc_select_bank(sc, 2); 1190694c6518SBenno Rice sc->smc_mask = 0; 1191694c6518SBenno Rice smc_write_1(sc, MSK, 0); 1192694c6518SBenno Rice #ifdef DEVICE_POLLING 1193694c6518SBenno Rice ether_poll_deregister(sc->smc_ifp); 1194694c6518SBenno Rice sc->smc_ifp->if_capenable &= ~IFCAP_POLLING; 1195694c6518SBenno Rice #endif 1196694c6518SBenno Rice 1197694c6518SBenno Rice /* 1198694c6518SBenno Rice * Disable transmit and receive. 1199694c6518SBenno Rice */ 1200694c6518SBenno Rice smc_select_bank(sc, 0); 1201694c6518SBenno Rice smc_write_2(sc, TCR, 0); 1202694c6518SBenno Rice smc_write_2(sc, RCR, 0); 1203694c6518SBenno Rice 1204694c6518SBenno Rice sc->smc_ifp->if_drv_flags &= ~IFF_DRV_RUNNING; 1205694c6518SBenno Rice } 1206694c6518SBenno Rice 1207694c6518SBenno Rice static void 1208694c6518SBenno Rice smc_watchdog(void *arg) 1209694c6518SBenno Rice { 1210694c6518SBenno Rice struct ifnet *ifp; 1211694c6518SBenno Rice 1212694c6518SBenno Rice ifp = (struct ifnet *)arg; 1213694c6518SBenno Rice if_printf(ifp, "watchdog timeout\n"); 1214694c6518SBenno Rice smc_intr(ifp); 1215694c6518SBenno Rice } 1216694c6518SBenno Rice 1217694c6518SBenno Rice static void 1218694c6518SBenno Rice smc_init(void *context) 1219694c6518SBenno Rice { 1220694c6518SBenno Rice struct smc_softc *sc; 1221694c6518SBenno Rice 1222694c6518SBenno Rice sc = (struct smc_softc *)context; 1223694c6518SBenno Rice SMC_LOCK(sc); 1224694c6518SBenno Rice smc_init_locked(sc); 1225694c6518SBenno Rice SMC_UNLOCK(sc); 1226694c6518SBenno Rice } 1227694c6518SBenno Rice 1228694c6518SBenno Rice static void 1229694c6518SBenno Rice smc_init_locked(struct smc_softc *sc) 1230694c6518SBenno Rice { 1231694c6518SBenno Rice struct ifnet *ifp; 1232694c6518SBenno Rice 1233694c6518SBenno Rice ifp = sc->smc_ifp; 1234694c6518SBenno Rice 1235694c6518SBenno Rice SMC_ASSERT_LOCKED(sc); 1236694c6518SBenno Rice 1237694c6518SBenno Rice smc_reset(sc); 1238694c6518SBenno Rice smc_enable(sc); 1239694c6518SBenno Rice 1240694c6518SBenno Rice ifp->if_drv_flags |= IFF_DRV_RUNNING; 1241694c6518SBenno Rice ifp->if_drv_flags &= ~IFF_DRV_OACTIVE; 1242694c6518SBenno Rice 1243694c6518SBenno Rice smc_start_locked(ifp); 1244694c6518SBenno Rice 1245694c6518SBenno Rice if (sc->smc_mii_tick != NULL) 1246694c6518SBenno Rice callout_reset(&sc->smc_mii_tick_ch, hz, sc->smc_mii_tick, sc); 1247694c6518SBenno Rice 1248694c6518SBenno Rice #ifdef DEVICE_POLLING 1249694c6518SBenno Rice SMC_UNLOCK(sc); 1250694c6518SBenno Rice ether_poll_register(smc_poll, ifp); 1251694c6518SBenno Rice SMC_LOCK(sc); 1252694c6518SBenno Rice ifp->if_capenable |= IFCAP_POLLING; 1253694c6518SBenno Rice #endif 1254694c6518SBenno Rice } 1255694c6518SBenno Rice 1256694c6518SBenno Rice static int 1257694c6518SBenno Rice smc_ioctl(struct ifnet *ifp, u_long cmd, caddr_t data) 1258694c6518SBenno Rice { 1259694c6518SBenno Rice struct smc_softc *sc; 1260694c6518SBenno Rice int error; 1261694c6518SBenno Rice 1262694c6518SBenno Rice sc = ifp->if_softc; 1263694c6518SBenno Rice error = 0; 1264694c6518SBenno Rice 1265694c6518SBenno Rice switch (cmd) { 1266694c6518SBenno Rice case SIOCSIFFLAGS: 1267694c6518SBenno Rice if ((ifp->if_flags & IFF_UP) == 0 && 1268694c6518SBenno Rice (ifp->if_drv_flags & IFF_DRV_RUNNING) != 0) { 1269694c6518SBenno Rice SMC_LOCK(sc); 1270694c6518SBenno Rice smc_stop(sc); 1271694c6518SBenno Rice SMC_UNLOCK(sc); 1272694c6518SBenno Rice } else { 1273694c6518SBenno Rice smc_init(sc); 1274694c6518SBenno Rice if (sc->smc_mii_mediachg != NULL) 1275694c6518SBenno Rice sc->smc_mii_mediachg(sc); 1276694c6518SBenno Rice } 1277694c6518SBenno Rice break; 1278694c6518SBenno Rice 1279694c6518SBenno Rice case SIOCADDMULTI: 1280694c6518SBenno Rice case SIOCDELMULTI: 1281694c6518SBenno Rice /* XXX 1282694c6518SBenno Rice SMC_LOCK(sc); 1283694c6518SBenno Rice smc_setmcast(sc); 1284694c6518SBenno Rice SMC_UNLOCK(sc); 1285694c6518SBenno Rice */ 1286694c6518SBenno Rice error = EINVAL; 1287694c6518SBenno Rice break; 1288694c6518SBenno Rice 1289694c6518SBenno Rice case SIOCGIFMEDIA: 1290694c6518SBenno Rice case SIOCSIFMEDIA: 1291694c6518SBenno Rice if (sc->smc_mii_mediaioctl == NULL) { 1292694c6518SBenno Rice error = EINVAL; 1293694c6518SBenno Rice break; 1294694c6518SBenno Rice } 1295694c6518SBenno Rice sc->smc_mii_mediaioctl(sc, (struct ifreq *)data, cmd); 1296694c6518SBenno Rice break; 1297694c6518SBenno Rice 1298694c6518SBenno Rice default: 1299694c6518SBenno Rice error = ether_ioctl(ifp, cmd, data); 1300694c6518SBenno Rice break; 1301694c6518SBenno Rice } 1302694c6518SBenno Rice 1303694c6518SBenno Rice return (error); 1304694c6518SBenno Rice } 1305