/*- * Copyright 2008 Nathan Whitehorn. All rights reserved. * Copyright 2003 by Peter Grehan. All rights reserved. * Copyright (C) 1998, 1999, 2000 Tsubai Masanari. All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions * are met: * 1. Redistributions of source code must retain the above copyright * notice, this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright * notice, this list of conditions and the following disclaimer in the * documentation and/or other materials provided with the distribution. * 3. The name of the author may not be used to endorse or promote products * derived from this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT, * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED * AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF * SUCH DAMAGE. * * From: * NetBSD: if_bm.c,v 1.9.2.1 2000/11/01 15:02:49 tv Exp */ /* * BMAC/BMAC+ Macio cell 10/100 ethernet driver * The low-cost, low-feature Apple variant of the Sun HME */ #include __FBSDID("$FreeBSD$"); #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include MODULE_DEPEND(bm, ether, 1, 1, 1); MODULE_DEPEND(bm, miibus, 1, 1, 1); /* "controller miibus0" required. See GENERIC if you get errors here. */ #include "miibus_if.h" #include "if_bmreg.h" #include "if_bmvar.h" static int bm_probe (device_t); static int bm_attach (device_t); static int bm_detach (device_t); static void bm_shutdown (device_t); static void bm_start (struct ifnet *); static void bm_start_locked (struct ifnet *); static int bm_encap (struct bm_softc *sc, struct mbuf **m_head); static int bm_ioctl (struct ifnet *, u_long, caddr_t); static void bm_init (void *); static void bm_init_locked (struct bm_softc *sc); static void bm_chip_setup (struct bm_softc *sc); static void bm_stop (struct bm_softc *sc); static void bm_setladrf (struct bm_softc *sc); static void bm_dummypacket (struct bm_softc *sc); static void bm_txintr (void *xsc); static void bm_rxintr (void *xsc); static int bm_add_rxbuf (struct bm_softc *sc, int i); static int bm_add_rxbuf_dma (struct bm_softc *sc, int i); static void bm_enable_interrupts (struct bm_softc *sc); static void bm_disable_interrupts (struct bm_softc *sc); static void bm_tick (void *xsc); static int bm_ifmedia_upd (struct ifnet *); static void bm_ifmedia_sts (struct ifnet *, struct ifmediareq *); static void bm_miicsr_dwrite (struct bm_softc *, u_int16_t); static void bm_mii_writebit (struct bm_softc *, int); static int bm_mii_readbit (struct bm_softc *); static void bm_mii_sync (struct bm_softc *); static void bm_mii_send (struct bm_softc *, u_int32_t, int); static int bm_mii_readreg (struct bm_softc *, struct bm_mii_frame *); static int bm_mii_writereg (struct bm_softc *, struct bm_mii_frame *); static int bm_miibus_readreg (device_t, int, int); static int bm_miibus_writereg (device_t, int, int, int); static void bm_miibus_statchg (device_t); static device_method_t bm_methods[] = { /* Device interface */ DEVMETHOD(device_probe, bm_probe), DEVMETHOD(device_attach, bm_attach), DEVMETHOD(device_detach, bm_detach), DEVMETHOD(device_shutdown, bm_shutdown), /* bus interface, for miibus */ DEVMETHOD(bus_print_child, bus_generic_print_child), DEVMETHOD(bus_driver_added, bus_generic_driver_added), /* MII interface */ DEVMETHOD(miibus_readreg, bm_miibus_readreg), DEVMETHOD(miibus_writereg, bm_miibus_writereg), DEVMETHOD(miibus_statchg, bm_miibus_statchg), { 0, 0 } }; static driver_t bm_macio_driver = { "bm", bm_methods, sizeof(struct bm_softc) }; static devclass_t bm_devclass; DRIVER_MODULE(bm, macio, bm_macio_driver, bm_devclass, 0, 0); DRIVER_MODULE(miibus, bm, miibus_driver, miibus_devclass, 0, 0); /* * MII internal routines */ /* * Write to the MII csr, introducing a delay to allow valid * MII clock pulses to be formed */ static void bm_miicsr_dwrite(struct bm_softc *sc, u_int16_t val) { CSR_WRITE_2(sc, BM_MII_CSR, val); /* * Assume this is a clock toggle and generate a 1us delay * to cover both MII's 160ns high/low minimum and 400ns * cycle miniumum */ DELAY(1); } /* * Write a bit to the MII bus. */ static void bm_mii_writebit(struct bm_softc *sc, int bit) { u_int16_t regval; regval = BM_MII_OENABLE; if (bit) regval |= BM_MII_DATAOUT; bm_miicsr_dwrite(sc, regval); bm_miicsr_dwrite(sc, regval | BM_MII_CLK); bm_miicsr_dwrite(sc, regval); } /* * Read a bit from the MII bus. */ static int bm_mii_readbit(struct bm_softc *sc) { u_int16_t regval, bitin; /* ~BM_MII_OENABLE */ regval = 0; bm_miicsr_dwrite(sc, regval); bm_miicsr_dwrite(sc, regval | BM_MII_CLK); bm_miicsr_dwrite(sc, regval); bitin = CSR_READ_2(sc, BM_MII_CSR) & BM_MII_DATAIN; return (bitin == BM_MII_DATAIN); } /* * Sync the PHYs by setting data bit and strobing the clock 32 times. */ static void bm_mii_sync(struct bm_softc *sc) { int i; u_int16_t regval; regval = BM_MII_OENABLE | BM_MII_DATAOUT; bm_miicsr_dwrite(sc, regval); for (i = 0; i < 32; i++) { bm_miicsr_dwrite(sc, regval | BM_MII_CLK); bm_miicsr_dwrite(sc, regval); } } /* * Clock a series of bits through the MII. */ static void bm_mii_send(struct bm_softc *sc, u_int32_t bits, int cnt) { int i; for (i = (0x1 << (cnt - 1)); i; i >>= 1) bm_mii_writebit(sc, bits & i); } /* * Read a PHY register through the MII. */ static int bm_mii_readreg(struct bm_softc *sc, struct bm_mii_frame *frame) { int i, ack, bit; /* * Set up frame for RX. */ frame->mii_stdelim = BM_MII_STARTDELIM; frame->mii_opcode = BM_MII_READOP; frame->mii_turnaround = 0; frame->mii_data = 0; /* * Sync the PHYs */ bm_mii_sync(sc); /* * Send command/address info */ bm_mii_send(sc, frame->mii_stdelim, 2); bm_mii_send(sc, frame->mii_opcode, 2); bm_mii_send(sc, frame->mii_phyaddr, 5); bm_mii_send(sc, frame->mii_regaddr, 5); /* * Check for ack. */ ack = bm_mii_readbit(sc); /* * Now try reading data bits. If the ack failed, we still * need to clock through 16 cycles to keep the PHY(s) in sync. */ for (i = 0x8000; i; i >>= 1) { bit = bm_mii_readbit(sc); if (!ack && bit) frame->mii_data |= i; } /* * Skip through idle bit-times */ bm_mii_writebit(sc, 0); bm_mii_writebit(sc, 0); return ((ack) ? 1 : 0); } /* * Write to a PHY register through the MII. */ static int bm_mii_writereg(struct bm_softc *sc, struct bm_mii_frame *frame) { /* * Set up frame for tx */ frame->mii_stdelim = BM_MII_STARTDELIM; frame->mii_opcode = BM_MII_WRITEOP; frame->mii_turnaround = BM_MII_TURNAROUND; /* * Sync the phy and start the bitbang write sequence */ bm_mii_sync(sc); bm_mii_send(sc, frame->mii_stdelim, 2); bm_mii_send(sc, frame->mii_opcode, 2); bm_mii_send(sc, frame->mii_phyaddr, 5); bm_mii_send(sc, frame->mii_regaddr, 5); bm_mii_send(sc, frame->mii_turnaround, 2); bm_mii_send(sc, frame->mii_data, 16); /* * Idle bit. */ bm_mii_writebit(sc, 0); return (0); } /* * MII bus i/f */ static int bm_miibus_readreg(device_t dev, int phy, int reg) { struct bm_softc *sc; struct bm_mii_frame frame; sc = device_get_softc(dev); bzero(&frame, sizeof(frame)); frame.mii_phyaddr = phy; frame.mii_regaddr = reg; bm_mii_readreg(sc, &frame); return (frame.mii_data); } static int bm_miibus_writereg(device_t dev, int phy, int reg, int data) { struct bm_softc *sc; struct bm_mii_frame frame; sc = device_get_softc(dev); bzero(&frame, sizeof(frame)); frame.mii_phyaddr = phy; frame.mii_regaddr = reg; frame.mii_data = data; bm_mii_writereg(sc, &frame); return (0); } static void bm_miibus_statchg(device_t dev) { struct bm_softc *sc = device_get_softc(dev); uint16_t reg; int new_duplex; reg = CSR_READ_2(sc, BM_TX_CONFIG); new_duplex = IFM_OPTIONS(sc->sc_mii->mii_media_active) & IFM_FDX; if (new_duplex != sc->sc_duplex) { /* Turn off TX MAC while we fiddle its settings */ reg &= ~BM_ENABLE; CSR_WRITE_2(sc, BM_TX_CONFIG, reg); while (CSR_READ_2(sc, BM_TX_CONFIG) & BM_ENABLE) DELAY(10); } if (new_duplex && !sc->sc_duplex) reg |= BM_TX_IGNORECOLL | BM_TX_FULLDPX; else if (!new_duplex && sc->sc_duplex) reg &= ~(BM_TX_IGNORECOLL | BM_TX_FULLDPX); if (new_duplex != sc->sc_duplex) { /* Turn TX MAC back on */ reg |= BM_ENABLE; CSR_WRITE_2(sc, BM_TX_CONFIG, reg); sc->sc_duplex = new_duplex; } } /* * ifmedia/mii callbacks */ static int bm_ifmedia_upd(struct ifnet *ifp) { struct bm_softc *sc = ifp->if_softc; int error; BM_LOCK(sc); error = mii_mediachg(sc->sc_mii); BM_UNLOCK(sc); return (error); } static void bm_ifmedia_sts(struct ifnet *ifp, struct ifmediareq *ifm) { struct bm_softc *sc = ifp->if_softc; BM_LOCK(sc); mii_pollstat(sc->sc_mii); ifm->ifm_active = sc->sc_mii->mii_media_active; ifm->ifm_status = sc->sc_mii->mii_media_status; BM_UNLOCK(sc); } /* * Macio probe/attach */ static int bm_probe(device_t dev) { const char *dname = ofw_bus_get_name(dev); const char *dcompat = ofw_bus_get_compat(dev); /* * BMAC+ cells have a name of "ethernet" and * a compatible property of "bmac+" */ if (strcmp(dname, "bmac") == 0) { device_set_desc(dev, "Apple BMAC Ethernet Adaptor"); } else if (strcmp(dcompat, "bmac+") == 0) { device_set_desc(dev, "Apple BMAC+ Ethernet Adaptor"); } else return (ENXIO); return (0); } static int bm_attach(device_t dev) { phandle_t node; u_char *eaddr; struct ifnet *ifp; int error, cellid, i; struct bm_txsoft *txs; struct bm_softc *sc = device_get_softc(dev); ifp = sc->sc_ifp = if_alloc(IFT_ETHER); ifp->if_softc = sc; sc->sc_dev = dev; sc->sc_duplex = ~IFM_FDX; error = 0; mtx_init(&sc->sc_mtx, device_get_nameunit(dev), MTX_NETWORK_LOCK, MTX_DEF); callout_init_mtx(&sc->sc_tick_ch, &sc->sc_mtx, 0); /* Check for an improved version of Paddington */ sc->sc_streaming = 0; cellid = -1; node = ofw_bus_get_node(dev); OF_getprop(node, "cell-id", &cellid, sizeof(cellid)); if (cellid >= 0xc4) sc->sc_streaming = 1; sc->sc_memrid = 0; sc->sc_memr = bus_alloc_resource_any(dev, SYS_RES_MEMORY, &sc->sc_memrid, RF_ACTIVE); if (sc->sc_memr == NULL) { device_printf(dev, "Could not alloc chip registers!\n"); return (ENXIO); } sc->sc_txdmarid = BM_TXDMA_REGISTERS; sc->sc_rxdmarid = BM_RXDMA_REGISTERS; sc->sc_txdmar = bus_alloc_resource_any(dev, SYS_RES_MEMORY, &sc->sc_txdmarid, RF_ACTIVE); sc->sc_rxdmar = bus_alloc_resource_any(dev, SYS_RES_MEMORY, &sc->sc_rxdmarid, RF_ACTIVE); if (sc->sc_txdmar == NULL || sc->sc_rxdmar == NULL) { device_printf(dev, "Could not map DBDMA registers!\n"); return (ENXIO); } error = dbdma_allocate_channel(sc->sc_txdmar, 0, bus_get_dma_tag(dev), BM_MAX_DMA_COMMANDS, &sc->sc_txdma); error += dbdma_allocate_channel(sc->sc_rxdmar, 0, bus_get_dma_tag(dev), BM_MAX_DMA_COMMANDS, &sc->sc_rxdma); if (error) { device_printf(dev,"Could not allocate DBDMA channel!\n"); return (ENXIO); } /* alloc DMA tags and buffers */ error = bus_dma_tag_create(bus_get_dma_tag(dev), 1, 0, BUS_SPACE_MAXADDR_32BIT, BUS_SPACE_MAXADDR, NULL, NULL, BUS_SPACE_MAXSIZE_32BIT, 0, BUS_SPACE_MAXSIZE_32BIT, 0, NULL, NULL, &sc->sc_pdma_tag); if (error) { device_printf(dev,"Could not allocate DMA tag!\n"); return (ENXIO); } error = bus_dma_tag_create(sc->sc_pdma_tag, 1, 0, BUS_SPACE_MAXADDR, BUS_SPACE_MAXADDR, NULL, NULL, MCLBYTES, 1, MCLBYTES, BUS_DMA_ALLOCNOW, NULL, NULL, &sc->sc_rdma_tag); if (error) { device_printf(dev,"Could not allocate RX DMA channel!\n"); return (ENXIO); } error = bus_dma_tag_create(sc->sc_pdma_tag, 1, 0, BUS_SPACE_MAXADDR, BUS_SPACE_MAXADDR, NULL, NULL, MCLBYTES * BM_NTXSEGS, BM_NTXSEGS, MCLBYTES, BUS_DMA_ALLOCNOW, NULL, NULL, &sc->sc_tdma_tag); if (error) { device_printf(dev,"Could not allocate TX DMA tag!\n"); return (ENXIO); } /* init transmit descriptors */ STAILQ_INIT(&sc->sc_txfreeq); STAILQ_INIT(&sc->sc_txdirtyq); /* create TX DMA maps */ error = ENOMEM; for (i = 0; i < BM_MAX_TX_PACKETS; i++) { txs = &sc->sc_txsoft[i]; txs->txs_mbuf = NULL; error = bus_dmamap_create(sc->sc_tdma_tag, 0, &txs->txs_dmamap); if (error) { device_printf(sc->sc_dev, "unable to create TX DMA map %d, error = %d\n", i, error); } STAILQ_INSERT_TAIL(&sc->sc_txfreeq, txs, txs_q); } /* Create the receive buffer DMA maps. */ for (i = 0; i < BM_MAX_RX_PACKETS; i++) { error = bus_dmamap_create(sc->sc_rdma_tag, 0, &sc->sc_rxsoft[i].rxs_dmamap); if (error) { device_printf(sc->sc_dev, "unable to create RX DMA map %d, error = %d\n", i, error); } sc->sc_rxsoft[i].rxs_mbuf = NULL; } /* alloc interrupt */ sc->sc_txdmairqid = BM_TXDMA_INTERRUPT; sc->sc_txdmairq = bus_alloc_resource_any(dev, SYS_RES_IRQ, &sc->sc_txdmairqid, RF_ACTIVE); if (error) { device_printf(dev,"Could not allocate TX interrupt!\n"); return (ENXIO); } bus_setup_intr(dev,sc->sc_txdmairq, INTR_TYPE_MISC | INTR_MPSAFE | INTR_ENTROPY, NULL, bm_txintr, sc, &sc->sc_txihtx); sc->sc_rxdmairqid = BM_RXDMA_INTERRUPT; sc->sc_rxdmairq = bus_alloc_resource_any(dev, SYS_RES_IRQ, &sc->sc_rxdmairqid, RF_ACTIVE); if (error) { device_printf(dev,"Could not allocate RX interrupt!\n"); return (ENXIO); } bus_setup_intr(dev,sc->sc_rxdmairq, INTR_TYPE_MISC | INTR_MPSAFE | INTR_ENTROPY, NULL, bm_rxintr, sc, &sc->sc_rxih); /* * Get the ethernet address from OpenFirmware */ eaddr = sc->sc_enaddr; OF_getprop(node, "local-mac-address", eaddr, ETHER_ADDR_LEN); /* reset the adapter */ bm_chip_setup(sc); /* setup MII */ error = mii_phy_probe(dev, &sc->sc_miibus, bm_ifmedia_upd, bm_ifmedia_sts); if (error != 0) device_printf(dev,"PHY probe failed: %d\n", error); sc->sc_mii = device_get_softc(sc->sc_miibus); if_initname(ifp, device_get_name(sc->sc_dev), device_get_unit(sc->sc_dev)); ifp->if_mtu = ETHERMTU; ifp->if_flags = IFF_BROADCAST | IFF_SIMPLEX | IFF_MULTICAST; ifp->if_start = bm_start; ifp->if_ioctl = bm_ioctl; ifp->if_init = bm_init; IFQ_SET_MAXLEN(&ifp->if_snd, BM_MAX_TX_PACKETS); ifp->if_snd.ifq_drv_maxlen = BM_MAX_TX_PACKETS; IFQ_SET_READY(&ifp->if_snd); /* Attach the interface. */ ether_ifattach(ifp, sc->sc_enaddr); ifp->if_hwassist = 0; return (0); } static int bm_detach(device_t dev) { struct bm_softc *sc = device_get_softc(dev); BM_LOCK(sc); bm_stop(sc); BM_UNLOCK(sc); callout_drain(&sc->sc_tick_ch); ether_ifdetach(sc->sc_ifp); bus_teardown_intr(dev, sc->sc_txdmairq, sc->sc_txihtx); bus_teardown_intr(dev, sc->sc_rxdmairq, sc->sc_rxih); dbdma_free_channel(sc->sc_txdma); dbdma_free_channel(sc->sc_rxdma); bus_release_resource(dev, SYS_RES_MEMORY, sc->sc_memrid, sc->sc_memr); bus_release_resource(dev, SYS_RES_MEMORY, sc->sc_txdmarid, sc->sc_txdmar); bus_release_resource(dev, SYS_RES_MEMORY, sc->sc_rxdmarid, sc->sc_rxdmar); bus_release_resource(dev, SYS_RES_IRQ, sc->sc_txdmairqid, sc->sc_txdmairq); bus_release_resource(dev, SYS_RES_IRQ, sc->sc_rxdmairqid, sc->sc_rxdmairq); mtx_destroy(&sc->sc_mtx); if_free(sc->sc_ifp); return (0); } static void bm_shutdown(device_t dev) { struct bm_softc *sc; sc = device_get_softc(dev); BM_LOCK(sc); bm_stop(sc); BM_UNLOCK(sc); } static void bm_dummypacket(struct bm_softc *sc) { struct mbuf *m; struct ifnet *ifp; ifp = sc->sc_ifp; MGETHDR(m, M_DONTWAIT, MT_DATA); if (m == NULL) return; bcopy(sc->sc_enaddr, mtod(m, struct ether_header *)->ether_dhost, ETHER_ADDR_LEN); bcopy(sc->sc_enaddr, mtod(m, struct ether_header *)->ether_shost, ETHER_ADDR_LEN); mtod(m, struct ether_header *)->ether_type = htons(3); mtod(m, unsigned char *)[14] = 0; mtod(m, unsigned char *)[15] = 0; mtod(m, unsigned char *)[16] = 0xE3; m->m_len = m->m_pkthdr.len = sizeof(struct ether_header) + 3; IF_ENQUEUE(&ifp->if_snd, m); bm_start_locked(ifp); } static void bm_rxintr(void *xsc) { struct bm_softc *sc = xsc; struct ifnet *ifp = sc->sc_ifp; struct mbuf *m; int i, prev_stop, new_stop; uint16_t status; BM_LOCK(sc); status = dbdma_get_chan_status(sc->sc_rxdma); if (status & DBDMA_STATUS_DEAD) { dbdma_reset(sc->sc_rxdma); BM_UNLOCK(sc); return; } if (!(status & DBDMA_STATUS_RUN)) { device_printf(sc->sc_dev,"Bad RX Interrupt!\n"); BM_UNLOCK(sc); return; } prev_stop = sc->next_rxdma_slot - 1; if (prev_stop < 0) prev_stop = sc->rxdma_loop_slot - 1; if (prev_stop < 0) { BM_UNLOCK(sc); return; } new_stop = -1; dbdma_sync_commands(sc->sc_rxdma, BUS_DMASYNC_POSTREAD); for (i = sc->next_rxdma_slot; i < BM_MAX_RX_PACKETS; i++) { if (i == sc->rxdma_loop_slot) i = 0; if (i == prev_stop) break; status = dbdma_get_cmd_status(sc->sc_rxdma, i); if (status == 0) break; m = sc->sc_rxsoft[i].rxs_mbuf; if (bm_add_rxbuf(sc, i)) { ifp->if_ierrors++; m = NULL; continue; } if (m == NULL) continue; ifp->if_ipackets++; m->m_pkthdr.rcvif = ifp; m->m_len -= (dbdma_get_residuals(sc->sc_rxdma, i) + 2); m->m_pkthdr.len = m->m_len; /* Send up the stack */ BM_UNLOCK(sc); (*ifp->if_input)(ifp, m); BM_LOCK(sc); /* Clear all fields on this command */ bm_add_rxbuf_dma(sc, i); new_stop = i; } /* Change the last packet we processed to the ring buffer terminator, * and restore a receive buffer to the old terminator */ if (new_stop >= 0) { dbdma_insert_stop(sc->sc_rxdma, new_stop); bm_add_rxbuf_dma(sc, prev_stop); if (i < sc->rxdma_loop_slot) sc->next_rxdma_slot = i; else sc->next_rxdma_slot = 0; } dbdma_sync_commands(sc->sc_rxdma, BUS_DMASYNC_PREWRITE); dbdma_wake(sc->sc_rxdma); BM_UNLOCK(sc); } static void bm_txintr(void *xsc) { struct bm_softc *sc = xsc; struct ifnet *ifp = sc->sc_ifp; struct bm_txsoft *txs; int progress = 0; BM_LOCK(sc); while ((txs = STAILQ_FIRST(&sc->sc_txdirtyq)) != NULL) { if (!dbdma_get_cmd_status(sc->sc_txdma, txs->txs_lastdesc)) break; STAILQ_REMOVE_HEAD(&sc->sc_txdirtyq, txs_q); bus_dmamap_unload(sc->sc_tdma_tag, txs->txs_dmamap); if (txs->txs_mbuf != NULL) { m_freem(txs->txs_mbuf); txs->txs_mbuf = NULL; } /* Set the first used TXDMA slot to the location of the * STOP/NOP command associated with this packet. */ sc->first_used_txdma_slot = txs->txs_stopdesc; STAILQ_INSERT_TAIL(&sc->sc_txfreeq, txs, txs_q); ifp->if_opackets++; progress = 1; } if (progress) { /* * We freed some descriptors, so reset IFF_DRV_OACTIVE * and restart. */ ifp->if_drv_flags &= ~IFF_DRV_OACTIVE; sc->sc_wdog_timer = STAILQ_EMPTY(&sc->sc_txdirtyq) ? 0 : 5; if ((ifp->if_drv_flags & IFF_DRV_RUNNING) && !IFQ_DRV_IS_EMPTY(&ifp->if_snd)) bm_start_locked(ifp); } BM_UNLOCK(sc); } static void bm_start(struct ifnet *ifp) { struct bm_softc *sc = ifp->if_softc; BM_LOCK(sc); bm_start_locked(ifp); BM_UNLOCK(sc); } static void bm_start_locked(struct ifnet *ifp) { struct bm_softc *sc = ifp->if_softc; struct mbuf *mb_head; int prev_stop; int txqueued = 0; /* * We lay out our DBDMA program in the following manner: * OUTPUT_MORE * ... * OUTPUT_LAST (+ Interrupt) * STOP * * To extend the channel, we append a new program, * then replace STOP with NOP and wake the channel. * If we stalled on the STOP already, the program proceeds, * if not it will sail through the NOP. */ while (!IFQ_DRV_IS_EMPTY(&ifp->if_snd)) { IFQ_DRV_DEQUEUE(&ifp->if_snd, mb_head); if (mb_head == NULL) break; prev_stop = sc->next_txdma_slot - 1; if (bm_encap(sc, &mb_head)) { /* Put the packet back and stop */ ifp->if_drv_flags |= IFF_DRV_OACTIVE; IFQ_DRV_PREPEND(&ifp->if_snd, mb_head); break; } dbdma_insert_nop(sc->sc_txdma, prev_stop); txqueued = 1; BPF_MTAP(ifp, mb_head); } dbdma_sync_commands(sc->sc_txdma, BUS_DMASYNC_PREWRITE); if (txqueued) { dbdma_wake(sc->sc_txdma); sc->sc_wdog_timer = 5; } } static int bm_encap(struct bm_softc *sc, struct mbuf **m_head) { bus_dma_segment_t segs[BM_NTXSEGS]; struct bm_txsoft *txs; struct mbuf *m; int nsegs = BM_NTXSEGS; int error = 0; uint8_t branch_type; int i; /* Limit the command size to the number of free DBDMA slots */ if (sc->next_txdma_slot >= sc->first_used_txdma_slot) nsegs = BM_MAX_DMA_COMMANDS - 2 - sc->next_txdma_slot + sc->first_used_txdma_slot; /* -2 for branch and indexing */ else nsegs = sc->first_used_txdma_slot - sc->next_txdma_slot; /* Remove one slot for the STOP/NOP terminator */ nsegs--; if (nsegs > BM_NTXSEGS) nsegs = BM_NTXSEGS; /* Get a work queue entry. */ if ((txs = STAILQ_FIRST(&sc->sc_txfreeq)) == NULL) { /* Ran out of descriptors. */ return (ENOBUFS); } error = bus_dmamap_load_mbuf_sg(sc->sc_tdma_tag, txs->txs_dmamap, *m_head, segs, &nsegs, BUS_DMA_NOWAIT); if (error == EFBIG) { m = m_collapse(*m_head, M_DONTWAIT, nsegs); if (m == NULL) { m_freem(*m_head); *m_head = NULL; return (ENOBUFS); } *m_head = m; error = bus_dmamap_load_mbuf_sg(sc->sc_tdma_tag, txs->txs_dmamap, *m_head, segs, &nsegs, BUS_DMA_NOWAIT); if (error != 0) { m_freem(*m_head); *m_head = NULL; return (error); } } else if (error != 0) return (error); if (nsegs == 0) { m_freem(*m_head); *m_head = NULL; return (EIO); } txs->txs_ndescs = nsegs; txs->txs_firstdesc = sc->next_txdma_slot; for (i = 0; i < nsegs; i++) { /* Loop back to the beginning if this is our last slot */ if (sc->next_txdma_slot == (BM_MAX_DMA_COMMANDS - 1)) branch_type = DBDMA_ALWAYS; else branch_type = DBDMA_NEVER; if (i+1 == nsegs) txs->txs_lastdesc = sc->next_txdma_slot; dbdma_insert_command(sc->sc_txdma, sc->next_txdma_slot++, (i + 1 < nsegs) ? DBDMA_OUTPUT_MORE : DBDMA_OUTPUT_LAST, 0, segs[i].ds_addr, segs[i].ds_len, (i + 1 < nsegs) ? DBDMA_NEVER : DBDMA_ALWAYS, branch_type, DBDMA_NEVER, 0); if (branch_type == DBDMA_ALWAYS) sc->next_txdma_slot = 0; } /* We have a corner case where the STOP command is the last slot, * but you can't branch in STOP commands. So add a NOP branch here * and the STOP in slot 0. */ if (sc->next_txdma_slot == (BM_MAX_DMA_COMMANDS - 1)) { dbdma_insert_branch(sc->sc_txdma, sc->next_txdma_slot, 0); sc->next_txdma_slot = 0; } txs->txs_stopdesc = sc->next_txdma_slot; dbdma_insert_stop(sc->sc_txdma, sc->next_txdma_slot++); STAILQ_REMOVE_HEAD(&sc->sc_txfreeq, txs_q); STAILQ_INSERT_TAIL(&sc->sc_txdirtyq, txs, txs_q); txs->txs_mbuf = *m_head; return (0); } static int bm_ioctl(struct ifnet *ifp, u_long cmd, caddr_t data) { struct bm_softc *sc = ifp->if_softc; struct ifreq *ifr = (struct ifreq *)data; int error; error = 0; switch(cmd) { case SIOCSIFFLAGS: BM_LOCK(sc); if ((ifp->if_flags & IFF_UP) != 0) { if ((ifp->if_drv_flags & IFF_DRV_RUNNING) != 0 && ((ifp->if_flags ^ sc->sc_ifpflags) & (IFF_ALLMULTI | IFF_PROMISC)) != 0) bm_setladrf(sc); else bm_init_locked(sc); } else if ((ifp->if_drv_flags & IFF_DRV_RUNNING) != 0) bm_stop(sc); sc->sc_ifpflags = ifp->if_flags; BM_UNLOCK(sc); break; case SIOCADDMULTI: case SIOCDELMULTI: BM_LOCK(sc); bm_setladrf(sc); BM_UNLOCK(sc); case SIOCGIFMEDIA: case SIOCSIFMEDIA: error = ifmedia_ioctl(ifp, ifr, &sc->sc_mii->mii_media, cmd); break; default: error = ether_ioctl(ifp, cmd, data); break; } return (error); } static void bm_setladrf(struct bm_softc *sc) { struct ifnet *ifp = sc->sc_ifp; struct ifmultiaddr *inm; uint16_t hash[4]; uint16_t reg; uint32_t crc; reg = BM_CRC_ENABLE | BM_REJECT_OWN_PKTS; /* Turn off RX MAC while we fiddle its settings */ CSR_WRITE_2(sc, BM_RX_CONFIG, reg); while (CSR_READ_2(sc, BM_RX_CONFIG) & BM_ENABLE) DELAY(10); if ((ifp->if_flags & IFF_PROMISC) != 0) { reg |= BM_PROMISC; CSR_WRITE_2(sc, BM_RX_CONFIG, reg); DELAY(15); reg = CSR_READ_2(sc, BM_RX_CONFIG); reg |= BM_ENABLE; CSR_WRITE_2(sc, BM_RX_CONFIG, reg); return; } if ((ifp->if_flags & IFF_ALLMULTI) != 0) { hash[3] = hash[2] = hash[1] = hash[0] = 0xffff; } else { /* Clear the hash table. */ memset(hash, 0, sizeof(hash)); IF_ADDR_LOCK(ifp); TAILQ_FOREACH(inm, &ifp->if_multiaddrs, ifma_link) { if (inm->ifma_addr->sa_family != AF_LINK) continue; crc = ether_crc32_le(LLADDR((struct sockaddr_dl *) inm->ifma_addr), ETHER_ADDR_LEN); /* We just want the 6 most significant bits */ crc >>= 26; /* Set the corresponding bit in the filter. */ hash[crc >> 4] |= 1 << (crc & 0xf); } IF_ADDR_UNLOCK(ifp); } /* Write out new hash table */ CSR_WRITE_2(sc, BM_HASHTAB0, hash[0]); CSR_WRITE_2(sc, BM_HASHTAB1, hash[1]); CSR_WRITE_2(sc, BM_HASHTAB2, hash[2]); CSR_WRITE_2(sc, BM_HASHTAB3, hash[3]); /* And turn the RX MAC back on, this time with the hash bit set */ reg |= BM_HASH_FILTER_ENABLE; CSR_WRITE_2(sc, BM_RX_CONFIG, reg); while (!(CSR_READ_2(sc, BM_RX_CONFIG) & BM_HASH_FILTER_ENABLE)) DELAY(10); reg = CSR_READ_2(sc, BM_RX_CONFIG); reg |= BM_ENABLE; CSR_WRITE_2(sc, BM_RX_CONFIG, reg); } static void bm_init(void *xsc) { struct bm_softc *sc = xsc; BM_LOCK(sc); bm_init_locked(sc); BM_UNLOCK(sc); } static void bm_chip_setup(struct bm_softc *sc) { uint16_t reg; uint16_t *eaddr_sect; char path[128]; ihandle_t bmac_ih; eaddr_sect = (uint16_t *)(sc->sc_enaddr); /* * Enable BMAC cell by opening and closing its OF node. This enables * the cell in macio as a side effect. We should probably directly * twiddle the FCR bits, but we lack a good interface for this at the * present time. */ OF_package_to_path(ofw_bus_get_node(sc->sc_dev), path, sizeof(path)); bmac_ih = OF_open(path); if (bmac_ih == -1) { device_printf(sc->sc_dev, "Enabling BMAC cell failed! Hoping it's already active.\n"); } else { OF_close(bmac_ih); } /* Reset chip */ CSR_WRITE_2(sc, BM_RX_RESET, 0x0000); CSR_WRITE_2(sc, BM_TX_RESET, 0x0001); do { reg = CSR_READ_2(sc, BM_TX_RESET); } while (reg & 0x0001); /* Some random junk. OS X uses the system time. We use * the low 16 bits of the MAC address. */ CSR_WRITE_2(sc, BM_TX_RANDSEED, eaddr_sect[2]); /* Enable transmit */ reg = CSR_READ_2(sc, BM_TX_IFC); reg |= BM_ENABLE; CSR_WRITE_2(sc, BM_TX_IFC, reg); CSR_READ_2(sc, BM_TX_PEAKCNT); } static void bm_stop(struct bm_softc *sc) { struct bm_txsoft *txs; uint16_t reg; /* Disable TX and RX MACs */ reg = CSR_READ_2(sc, BM_TX_CONFIG); reg &= ~BM_ENABLE; CSR_WRITE_2(sc, BM_TX_CONFIG, reg); reg = CSR_READ_2(sc, BM_RX_CONFIG); reg &= ~BM_ENABLE; CSR_WRITE_2(sc, BM_RX_CONFIG, reg); DELAY(100); /* Stop DMA engine */ dbdma_stop(sc->sc_rxdma); dbdma_stop(sc->sc_txdma); sc->next_rxdma_slot = 0; sc->rxdma_loop_slot = 0; /* Disable interrupts */ bm_disable_interrupts(sc); /* Don't worry about pending transmits anymore */ while ((txs = STAILQ_FIRST(&sc->sc_txdirtyq)) != NULL) { STAILQ_REMOVE_HEAD(&sc->sc_txdirtyq, txs_q); if (txs->txs_ndescs != 0) { bus_dmamap_sync(sc->sc_tdma_tag, txs->txs_dmamap, BUS_DMASYNC_POSTWRITE); bus_dmamap_unload(sc->sc_tdma_tag, txs->txs_dmamap); if (txs->txs_mbuf != NULL) { m_freem(txs->txs_mbuf); txs->txs_mbuf = NULL; } } STAILQ_INSERT_TAIL(&sc->sc_txfreeq, txs, txs_q); } /* And we're down */ sc->sc_ifp->if_drv_flags &= ~(IFF_DRV_RUNNING | IFF_DRV_OACTIVE); sc->sc_wdog_timer = 0; callout_stop(&sc->sc_tick_ch); } static void bm_init_locked(struct bm_softc *sc) { uint16_t reg; uint16_t *eaddr_sect; struct bm_rxsoft *rxs; int i; eaddr_sect = (uint16_t *)(sc->sc_enaddr); /* Zero RX slot info and stop DMA */ dbdma_stop(sc->sc_rxdma); dbdma_stop(sc->sc_txdma); sc->next_rxdma_slot = 0; sc->rxdma_loop_slot = 0; /* Initialize TX/RX DBDMA programs */ dbdma_insert_stop(sc->sc_rxdma, 0); dbdma_insert_stop(sc->sc_txdma, 0); dbdma_set_current_cmd(sc->sc_rxdma, 0); dbdma_set_current_cmd(sc->sc_txdma, 0); sc->next_rxdma_slot = 0; sc->next_txdma_slot = 1; sc->first_used_txdma_slot = 0; for (i = 0; i < BM_MAX_RX_PACKETS; i++) { rxs = &sc->sc_rxsoft[i]; rxs->dbdma_slot = i; if (rxs->rxs_mbuf == NULL) { bm_add_rxbuf(sc, i); if (rxs->rxs_mbuf == NULL) { /* If we can't add anymore, mark the problem */ rxs->dbdma_slot = -1; break; } } if (i > 0) bm_add_rxbuf_dma(sc, i); } /* * Now terminate the RX ring buffer, and follow with the loop to * the beginning. */ dbdma_insert_stop(sc->sc_rxdma, i - 1); dbdma_insert_branch(sc->sc_rxdma, i, 0); sc->rxdma_loop_slot = i; /* Now add in the first element of the RX DMA chain */ bm_add_rxbuf_dma(sc, 0); dbdma_sync_commands(sc->sc_rxdma, BUS_DMASYNC_PREWRITE); dbdma_sync_commands(sc->sc_txdma, BUS_DMASYNC_PREWRITE); /* Zero collision counters */ CSR_WRITE_2(sc, BM_TX_NCCNT, 0); CSR_WRITE_2(sc, BM_TX_FCCNT, 0); CSR_WRITE_2(sc, BM_TX_EXCNT, 0); CSR_WRITE_2(sc, BM_TX_LTCNT, 0); /* Zero receive counters */ CSR_WRITE_2(sc, BM_RX_FRCNT, 0); CSR_WRITE_2(sc, BM_RX_LECNT, 0); CSR_WRITE_2(sc, BM_RX_AECNT, 0); CSR_WRITE_2(sc, BM_RX_FECNT, 0); CSR_WRITE_2(sc, BM_RXCV, 0); /* Prime transmit */ CSR_WRITE_2(sc, BM_TX_THRESH, 0xff); CSR_WRITE_2(sc, BM_TXFIFO_CSR, 0); CSR_WRITE_2(sc, BM_TXFIFO_CSR, 0x0001); /* Prime receive */ CSR_WRITE_2(sc, BM_RXFIFO_CSR, 0); CSR_WRITE_2(sc, BM_RXFIFO_CSR, 0x0001); /* Clear status reg */ CSR_READ_2(sc, BM_STATUS); /* Zero hash filters */ CSR_WRITE_2(sc, BM_HASHTAB0, 0); CSR_WRITE_2(sc, BM_HASHTAB1, 0); CSR_WRITE_2(sc, BM_HASHTAB2, 0); CSR_WRITE_2(sc, BM_HASHTAB3, 0); /* Write MAC address to chip */ CSR_WRITE_2(sc, BM_MACADDR0, eaddr_sect[0]); CSR_WRITE_2(sc, BM_MACADDR1, eaddr_sect[1]); CSR_WRITE_2(sc, BM_MACADDR2, eaddr_sect[2]); /* Final receive engine setup */ reg = BM_CRC_ENABLE | BM_REJECT_OWN_PKTS | BM_HASH_FILTER_ENABLE; CSR_WRITE_2(sc, BM_RX_CONFIG, reg); /* Now turn it all on! */ dbdma_reset(sc->sc_rxdma); dbdma_reset(sc->sc_txdma); /* Enable RX and TX MACs. Setting the address filter has * the side effect of enabling the RX MAC. */ bm_setladrf(sc); reg = CSR_READ_2(sc, BM_TX_CONFIG); reg |= BM_ENABLE; CSR_WRITE_2(sc, BM_TX_CONFIG, reg); /* * Enable interrupts, unwedge the controller with a dummy packet, * and nudge the DMA queue. */ bm_enable_interrupts(sc); bm_dummypacket(sc); dbdma_wake(sc->sc_rxdma); /* Nudge RXDMA */ sc->sc_ifp->if_drv_flags |= IFF_DRV_RUNNING; sc->sc_ifp->if_drv_flags &= ~IFF_DRV_OACTIVE; sc->sc_ifpflags = sc->sc_ifp->if_flags; /* Resync PHY and MAC states */ sc->sc_mii = device_get_softc(sc->sc_miibus); sc->sc_duplex = ~IFM_FDX; mii_mediachg(sc->sc_mii); /* Start the one second timer. */ sc->sc_wdog_timer = 0; callout_reset(&sc->sc_tick_ch, hz, bm_tick, sc); } static void bm_tick(void *arg) { struct bm_softc *sc = arg; /* Read error counters */ sc->sc_ifp->if_collisions += CSR_READ_2(sc, BM_TX_NCCNT) + CSR_READ_2(sc, BM_TX_FCCNT) + CSR_READ_2(sc, BM_TX_EXCNT) + CSR_READ_2(sc, BM_TX_LTCNT); sc->sc_ifp->if_ierrors += CSR_READ_2(sc, BM_RX_LECNT) + CSR_READ_2(sc, BM_RX_AECNT) + CSR_READ_2(sc, BM_RX_FECNT); /* Zero collision counters */ CSR_WRITE_2(sc, BM_TX_NCCNT, 0); CSR_WRITE_2(sc, BM_TX_FCCNT, 0); CSR_WRITE_2(sc, BM_TX_EXCNT, 0); CSR_WRITE_2(sc, BM_TX_LTCNT, 0); /* Zero receive counters */ CSR_WRITE_2(sc, BM_RX_FRCNT, 0); CSR_WRITE_2(sc, BM_RX_LECNT, 0); CSR_WRITE_2(sc, BM_RX_AECNT, 0); CSR_WRITE_2(sc, BM_RX_FECNT, 0); CSR_WRITE_2(sc, BM_RXCV, 0); /* Check for link changes and run watchdog */ mii_tick(sc->sc_mii); bm_miibus_statchg(sc->sc_dev); if (sc->sc_wdog_timer == 0 || --sc->sc_wdog_timer != 0) { callout_reset(&sc->sc_tick_ch, hz, bm_tick, sc); return; } /* Problems */ device_printf(sc->sc_dev, "device timeout\n"); bm_init_locked(sc); } static int bm_add_rxbuf(struct bm_softc *sc, int idx) { struct bm_rxsoft *rxs = &sc->sc_rxsoft[idx]; struct mbuf *m; bus_dma_segment_t segs[1]; int error, nsegs; m = m_getcl(M_DONTWAIT, MT_DATA, M_PKTHDR); if (m == NULL) return (ENOBUFS); m->m_len = m->m_pkthdr.len = m->m_ext.ext_size; if (rxs->rxs_mbuf != NULL) { bus_dmamap_sync(sc->sc_rdma_tag, rxs->rxs_dmamap, BUS_DMASYNC_POSTREAD); bus_dmamap_unload(sc->sc_rdma_tag, rxs->rxs_dmamap); } error = bus_dmamap_load_mbuf_sg(sc->sc_rdma_tag, rxs->rxs_dmamap, m, segs, &nsegs, BUS_DMA_NOWAIT); if (error != 0) { device_printf(sc->sc_dev, "cannot load RS DMA map %d, error = %d\n", idx, error); m_freem(m); return (error); } /* If nsegs is wrong then the stack is corrupt. */ KASSERT(nsegs == 1, ("%s: too many DMA segments (%d)", __func__, nsegs)); rxs->rxs_mbuf = m; rxs->segment = segs[0]; bus_dmamap_sync(sc->sc_rdma_tag, rxs->rxs_dmamap, BUS_DMASYNC_PREREAD); return (0); } static int bm_add_rxbuf_dma(struct bm_softc *sc, int idx) { struct bm_rxsoft *rxs = &sc->sc_rxsoft[idx]; dbdma_insert_command(sc->sc_rxdma, idx, DBDMA_INPUT_LAST, 0, rxs->segment.ds_addr, rxs->segment.ds_len, DBDMA_ALWAYS, DBDMA_NEVER, DBDMA_NEVER, 0); return (0); } static void bm_enable_interrupts(struct bm_softc *sc) { CSR_WRITE_2(sc, BM_INTR_DISABLE, (sc->sc_streaming) ? BM_INTR_NONE : BM_INTR_NORMAL); } static void bm_disable_interrupts(struct bm_softc *sc) { CSR_WRITE_2(sc, BM_INTR_DISABLE, BM_INTR_NONE); }