/* $NetBSD: if_temac.c,v 1.1.2.2 2006/12/10 07:15:54 yamt Exp $ */
/*
* Copyright (c) 2006 Jachym Holecek
* All rights reserved.
*
* Written for DFC Design, s.r.o.
*
* 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.
*
* 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.
*/
/*
* Driver for Xilinx LocalLink TEMAC as wired on the GSRD platform.
*
* TODO:
* - Optimize
* - Checksum offload
* - Address filters
* - Support jumbo frames
*/
#include <sys/cdefs.h>
__KERNEL_RCSID(0, "$NetBSD: if_temac.c,v 1.1.2.2 2006/12/10 07:15:54 yamt Exp $");
#include "bpfilter.h"
#include <sys/param.h>
#include <sys/systm.h>
#include <sys/mbuf.h>
#include <sys/kernel.h>
#include <sys/socket.h>
#include <sys/ioctl.h>
#include <sys/device.h>
#include <uvm/uvm_extern.h>
#include <net/if.h>
#include <net/if_dl.h>
#include <net/if_media.h>
#include <net/if_ether.h>
#if NBPFILTER > 0
#include <net/bpf.h>
#endif
#include <machine/bus.h>
#include <evbppc/virtex/idcr.h>
#include <evbppc/virtex/dev/xcvbusvar.h>
#include <evbppc/virtex/dev/cdmacreg.h>
#include <evbppc/virtex/dev/temacreg.h>
#include <evbppc/virtex/dev/temacvar.h>
#include <dev/mii/miivar.h>
/* This is outside of TEMAC's DCR window, we have to hardcode it... */
#define DCR_ETH_BASE 0x0030
#define TEMAC_REGDEBUG 0
#define TEMAC_RXDEBUG 0
#define TEMAC_TXDEBUG 0
#if TEMAC_RXDEBUG > 0 || TEMAC_TXDEBUG > 0
#define TEMAC_DEBUG 1
#else
#define TEMAC_DEBUG 0
#endif
#if TEMAC_REGDEBUG > 0
#define TRACEREG(arg) printf arg
#else
#define TRACEREG(arg) /* nop */
#endif
/* DMA control chains take up one (16KB) page. */
#define TEMAC_NTXDESC 256
#define TEMAC_NRXDESC 256
#define TEMAC_TXQLEN 64 /* Software Tx queue length */
#define TEMAC_NTXSEG 16 /* Maximum Tx segments per packet */
#define TEMAC_NRXSEG 1 /* Maximum Rx segments per packet */
#define TEMAC_RXPERIOD 1 /* Interrupt every N descriptors. */
#define TEMAC_RXTIMO_HZ 100 /* Rx reaper frequency */
/* Next Tx descriptor and descriptor's offset WRT sc_cdaddr. */
#define TEMAC_TXSINC(n, i) (((n) + TEMAC_TXQLEN + (i)) % TEMAC_TXQLEN)
#define TEMAC_TXINC(n, i) (((n) + TEMAC_NTXDESC + (i)) % TEMAC_NTXDESC)
#define TEMAC_TXSNEXT(n) TEMAC_TXSINC((n), 1)
#define TEMAC_TXNEXT(n) TEMAC_TXINC((n), 1)
#define TEMAC_TXDOFF(n) (offsetof(struct temac_control, cd_txdesc) + \
(n) * sizeof(struct cdmac_descr))
/* Next Rx descriptor and descriptor's offset WRT sc_cdaddr. */
#define TEMAC_RXINC(n, i) (((n) + TEMAC_NRXDESC + (i)) % TEMAC_NRXDESC)
#define TEMAC_RXNEXT(n) TEMAC_RXINC((n), 1)
#define TEMAC_RXDOFF(n) (offsetof(struct temac_control, cd_rxdesc) + \
(n) * sizeof(struct cdmac_descr))
#define TEMAC_ISINTR(i) (((i) % TEMAC_RXPERIOD) == 0)
#define TEMAC_ISLAST(i) ((i) == (TEMAC_NRXDESC - 1))
struct temac_control {
struct cdmac_descr cd_txdesc[TEMAC_NTXDESC];
struct cdmac_descr cd_rxdesc[TEMAC_NRXDESC];
};
struct temac_txsoft {
bus_dmamap_t txs_dmap;
struct mbuf *txs_mbuf;
int txs_last;
};
struct temac_rxsoft {
bus_dmamap_t rxs_dmap;
struct mbuf *rxs_mbuf;
};
struct temac_softc {
struct device sc_dev;
struct ethercom sc_ec;
#define sc_if sc_ec.ec_if
/* Peripheral registers */
bus_space_tag_t sc_iot;
bus_space_handle_t sc_ioh;
/* CDMAC channel registers */
bus_space_tag_t sc_dma_rxt;
bus_space_handle_t sc_dma_rxh; /* Rx channel */
bus_space_handle_t sc_dma_rsh; /* Rx status */
bus_space_tag_t sc_dma_txt;
bus_space_handle_t sc_dma_txh; /* Tx channel */
bus_space_handle_t sc_dma_tsh; /* Tx status */
struct temac_txsoft sc_txsoft[TEMAC_TXQLEN];
struct temac_rxsoft sc_rxsoft[TEMAC_NRXDESC];
struct callout sc_rx_timo;
struct callout sc_mii_tick;
struct mii_data sc_mii;
bus_dmamap_t sc_control_dmap;
#define sc_cdaddr sc_control_dmap->dm_segs[0].ds_addr
struct temac_control *sc_control_data;
#define sc_rxdescs sc_control_data->cd_rxdesc
#define sc_txdescs sc_control_data->cd_txdesc
int sc_txbusy;
int sc_txfree;
int sc_txcur;
int sc_txreap;
int sc_rxreap;
int sc_txsfree;
int sc_txscur;
int sc_txsreap;
int sc_dead; /* Rx/Tx DMA error (fatal) */
int sc_rx_drained;
int sc_rx_chan;
int sc_tx_chan;
void *sc_sdhook;
void *sc_rx_ih;
void *sc_tx_ih;
bus_dma_tag_t sc_dmat;
};
/* Device interface. */
static void temac_attach(struct device *, struct device *, void *);
/* Ifnet interface. */
static int temac_init(struct ifnet *);
static int temac_ioctl(struct ifnet *, u_long, caddr_t);
static void temac_start(struct ifnet *);
static void temac_stop(struct ifnet *, int);
/* Media management. */
static int temac_mediachange(struct ifnet *);
static void temac_mediastatus(struct ifnet *, struct ifmediareq *);
static int temac_mii_readreg(struct device *, int, int);
static void temac_mii_statchg(struct device *);
static void temac_mii_tick(void *);
static void temac_mii_writereg(struct device *, int, int, int);
/* Indirect hooks. */
static void temac_shutdown(void *);
static void temac_rx_intr(void *);
static void temac_tx_intr(void *);
/* Tools. */
static inline void temac_rxcdsync(struct temac_softc *, int, int, int);
static inline void temac_txcdsync(struct temac_softc *, int, int, int);
static void temac_txreap(struct temac_softc *);
static void temac_rxreap(struct temac_softc *);
static int temac_rxalloc(struct temac_softc *, int, int);
static void temac_rxtimo(void *);
static void temac_rxdrain(struct temac_softc *);
static void temac_reset(struct temac_softc *);
static void temac_txkick(struct temac_softc *);
/* Register access. */
static inline void gmi_write_8(uint32_t, uint32_t, uint32_t);
static inline void gmi_write_4(uint32_t, uint32_t);
static inline void gmi_read_8(uint32_t, uint32_t *, uint32_t *);
static inline uint32_t gmi_read_4(uint32_t);
static inline void hif_wait_stat(uint32_t);
#define cdmac_rx_stat(sc) \
bus_space_read_4((sc)->sc_dma_rxt, (sc)->sc_dma_rsh, 0 /* XXX hack */)
#define cdmac_rx_reset(sc) \
bus_space_write_4((sc)->sc_dma_rxt, (sc)->sc_dma_rsh, 0, CDMAC_STAT_RESET)
#define cdmac_rx_start(sc, val) \
bus_space_write_4((sc)->sc_dma_rxt, (sc)->sc_dma_rxh, CDMAC_CURDESC, (val))
#define cdmac_tx_stat(sc) \
bus_space_read_4((sc)->sc_dma_txt, (sc)->sc_dma_tsh, 0 /* XXX hack */)
#define cdmac_tx_reset(sc) \
bus_space_write_4((sc)->sc_dma_txt, (sc)->sc_dma_tsh, 0, CDMAC_STAT_RESET)
#define cdmac_tx_start(sc, val) \
bus_space_write_4((sc)->sc_dma_txt, (sc)->sc_dma_txh, CDMAC_CURDESC, (val))
CFATTACH_DECL(temac, sizeof(struct temac_softc),
xcvbus_child_match, temac_attach, NULL, NULL);
/*
* Private bus utilities.
*/
static inline void
hif_wait_stat(uint32_t mask)
{
int i = 0;
while (mask != (mfidcr(IDCR_HIF_STAT) & mask)) {
if (i++ > 100) {
printf("%s: timeout waiting for 0x%08x\n",
__func__, mask);
break;
}
delay(5);
}
TRACEREG(("%s: stat %#08x loops %d\n", __func__, mask, i));
}
static inline void
gmi_write_4(uint32_t addr, uint32_t lo)
{
mtidcr(IDCR_HIF_ARG0, lo);
mtidcr(IDCR_HIF_CTRL, (addr & HIF_CTRL_GMIADDR) | HIF_CTRL_WRITE);
hif_wait_stat(HIF_STAT_GMIWR);
TRACEREG(("%s: %#08x <- %#08x\n", __func__, addr, lo));
}
static inline void
gmi_write_8(uint32_t addr, uint32_t lo, uint32_t hi)
{
mtidcr(IDCR_HIF_ARG1, hi);
gmi_write_4(addr, lo);
}
static inline void
gmi_read_8(uint32_t addr, uint32_t *lo, uint32_t *hi)
{
*lo = gmi_read_4(addr);
*hi = mfidcr(IDCR_HIF_ARG1);
}
static inline uint32_t
gmi_read_4(uint32_t addr)
{
uint32_t res;
mtidcr(IDCR_HIF_CTRL, addr & HIF_CTRL_GMIADDR);
hif_wait_stat(HIF_STAT_GMIRR);
res = mfidcr(IDCR_HIF_ARG0);
TRACEREG(("%s: %#08x -> %#08x\n", __func__, addr, res));
return (res);
}
/*
* Generic device.
*/
static void
temac_attach(struct device *parent, struct device *self, void *aux)
{
struct xcvbus_attach_args *vaa = aux;
struct ll_dmac *rx = vaa->vaa_rx_dmac;
struct ll_dmac *tx = vaa->vaa_tx_dmac;
struct temac_softc *sc = (struct temac_softc *)self;
struct ifnet *ifp = &sc->sc_if;
struct mii_data *mii = &sc->sc_mii;
uint8_t enaddr[ETHER_ADDR_LEN];
bus_dma_segment_t seg;
int error, nseg, i;
printf(": TEMAC\n"); /* XXX will be LL_TEMAC, PLB_TEMAC */
KASSERT(rx);
KASSERT(tx);
sc->sc_dmat = vaa->vaa_dmat;
sc->sc_dead = 0;
sc->sc_rx_drained = 1;
sc->sc_txbusy = 0;
sc->sc_iot = vaa->vaa_iot;
sc->sc_dma_rxt = rx->dmac_iot;
sc->sc_dma_txt = tx->dmac_iot;
/*
* Map HIF and receive/transmit dmac registers.
*/
if ((error = bus_space_map(vaa->vaa_iot, vaa->vaa_addr, TEMAC_SIZE, 0,
&sc->sc_ioh)) != 0) {
printf("%s: could not map registers\n", device_xname(self));
goto fail_0;
}
if ((error = bus_space_map(sc->sc_dma_rxt, rx->dmac_ctrl_addr,
CDMAC_CTRL_SIZE, 0, &sc->sc_dma_rxh)) != 0) {
printf("%s: could not map Rx control registers\n",
device_xname(self));
goto fail_0;
}
if ((error = bus_space_map(sc->sc_dma_rxt, rx->dmac_stat_addr,
CDMAC_STAT_SIZE, 0, &sc->sc_dma_rsh)) != 0) {
printf("%s: could not map Rx status register\n",
device_xname(self));
goto fail_0;
}
if ((error = bus_space_map(sc->sc_dma_txt, tx->dmac_ctrl_addr,
CDMAC_CTRL_SIZE, 0, &sc->sc_dma_txh)) != 0) {
printf("%s: could not map Tx control registers\n",
device_xname(self));
goto fail_0;
}
if ((error = bus_space_map(sc->sc_dma_txt, tx->dmac_stat_addr,
CDMAC_STAT_SIZE, 0, &sc->sc_dma_tsh)) != 0) {
printf("%s: could not map Tx status register\n",
device_xname(self));
goto fail_0;
}
/*
* Allocate and initialize DMA control chains.
*/
if ((error = bus_dmamem_alloc(sc->sc_dmat,
sizeof(struct temac_control), 8, 0, &seg, 1, &nseg, 0)) != 0) {
printf("%s: could not allocate control data\n",
sc->sc_dev.dv_xname);
goto fail_0;
}
if ((error = bus_dmamem_map(sc->sc_dmat, &seg, nseg,
sizeof(struct temac_control),
(caddr_t *)&sc->sc_control_data, BUS_DMA_COHERENT)) != 0) {
printf("%s: could not map control data\n",
sc->sc_dev.dv_xname);
goto fail_1;
}
if ((error = bus_dmamap_create(sc->sc_dmat,
sizeof(struct temac_control), 1,
sizeof(struct temac_control), 0, 0, &sc->sc_control_dmap)) != 0) {
printf("%s: could not create control data DMA map\n",
sc->sc_dev.dv_xname);
goto fail_2;
}
if ((error = bus_dmamap_load(sc->sc_dmat, sc->sc_control_dmap,
sc->sc_control_data, sizeof(struct temac_control), NULL, 0)) != 0) {
printf("%s: could not load control data DMA map\n",
sc->sc_dev.dv_xname);
goto fail_3;
}
/*
* Link descriptor chains.
*/
memset(sc->sc_control_data, 0, sizeof(struct temac_control));
for (i = 0; i < TEMAC_NTXDESC; i++) {
sc->sc_txdescs[i].desc_next = sc->sc_cdaddr +
TEMAC_TXDOFF(TEMAC_TXNEXT(i));
sc->sc_txdescs[i].desc_stat = CDMAC_STAT_DONE;
}
for (i = 0; i < TEMAC_NRXDESC; i++) {
sc->sc_rxdescs[i].desc_next = sc->sc_cdaddr +
TEMAC_RXDOFF(TEMAC_RXNEXT(i));
sc->sc_txdescs[i].desc_stat = CDMAC_STAT_DONE;
}
bus_dmamap_sync(sc->sc_dmat, sc->sc_control_dmap, 0,
sizeof(struct temac_control),
BUS_DMASYNC_PREREAD | BUS_DMASYNC_PREWRITE);
/*
* Initialize software state for transmit/receive jobs.
*/
for (i = 0; i < TEMAC_TXQLEN; i++) {
if ((error = bus_dmamap_create(sc->sc_dmat,
ETHER_MAX_LEN_JUMBO, TEMAC_NTXSEG, ETHER_MAX_LEN_JUMBO,
0, 0, &sc->sc_txsoft[i].txs_dmap)) != 0) {
printf("%s: could not create Tx DMA map %d\n",
sc->sc_dev.dv_xname, i);
goto fail_4;
}
sc->sc_txsoft[i].txs_mbuf = NULL;
sc->sc_txsoft[i].txs_last = 0;
}
for (i = 0; i < TEMAC_NRXDESC; i++) {
if ((error = bus_dmamap_create(sc->sc_dmat,
MCLBYTES, TEMAC_NRXSEG, MCLBYTES, 0, 0,
&sc->sc_rxsoft[i].rxs_dmap)) != 0) {
printf("%s: could not create Rx DMA map %d\n",
sc->sc_dev.dv_xname, i);
goto fail_5;
}
sc->sc_rxsoft[i].rxs_mbuf = NULL;
}
/*
* Setup transfer interrupt handlers.
*/
error = ENOMEM;
sc->sc_rx_ih = ll_dmac_intr_establish(rx->dmac_chan,
temac_rx_intr, sc);
if (sc->sc_rx_ih == NULL) {
printf("%s: could not establish Rx interrupt\n",
device_xname(self));
goto fail_5;
}
sc->sc_tx_ih = ll_dmac_intr_establish(tx->dmac_chan,
temac_tx_intr, sc);
if (sc->sc_tx_ih == NULL) {
printf("%s: could not establish Tx interrupt\n",
device_xname(self));
goto fail_6;
}
/* XXXFreza: faked, should read unicast address filter. */
enaddr[0] = 0x00;
enaddr[1] = 0x11;
enaddr[2] = 0x17;
enaddr[3] = 0xff;
enaddr[4] = 0xff;
enaddr[5] = 0x01;
/*
* Initialize the TEMAC.
*/
temac_reset(sc);
/* Configure MDIO link. */
gmi_write_4(TEMAC_GMI_MGMTCF, GMI_MGMT_CLKDIV_100MHz | GMI_MGMT_MDIO);
/* Initialize PHY. */
mii->mii_ifp = ifp;
mii->mii_readreg = temac_mii_readreg;
mii->mii_writereg = temac_mii_writereg;
mii->mii_statchg = temac_mii_statchg;
ifmedia_init(&mii->mii_media, 0, temac_mediachange,
temac_mediastatus);
mii_attach(&sc->sc_dev, mii, 0xffffffff, MII_PHY_ANY,
MII_OFFSET_ANY, 0);
if (LIST_FIRST(&mii->mii_phys) == NULL) {
ifmedia_add(&mii->mii_media, IFM_ETHER|IFM_NONE, 0, NULL);
ifmedia_set(&mii->mii_media, IFM_ETHER|IFM_NONE);
} else {
ifmedia_set(&mii->mii_media, IFM_ETHER|IFM_AUTO);
}
/* Hold PHY in reset. */
bus_space_write_4(sc->sc_iot, sc->sc_ioh, TEMAC_RESET, TEMAC_RESET_PHY);
/* Reset EMAC. */
bus_space_write_4(sc->sc_iot, sc->sc_ioh, TEMAC_RESET,
TEMAC_RESET_EMAC);
delay(10000);
/* Reset peripheral, awakes PHY and EMAC. */
bus_space_write_4(sc->sc_iot, sc->sc_ioh, TEMAC_RESET,
TEMAC_RESET_PERIPH);
delay(40000);
/* (Re-)Configure MDIO link. */
gmi_write_4(TEMAC_GMI_MGMTCF, GMI_MGMT_CLKDIV_100MHz | GMI_MGMT_MDIO);
/*
* Hook up with network stack.
*/
strcpy(ifp->if_xname, sc->sc_dev.dv_xname);
ifp->if_softc = sc;
ifp->if_flags = IFF_BROADCAST | IFF_SIMPLEX | IFF_MULTICAST;
ifp->if_ioctl = temac_ioctl;
ifp->if_start = temac_start;
ifp->if_init = temac_init;
ifp->if_stop = temac_stop;
ifp->if_watchdog = NULL;
IFQ_SET_READY(&ifp->if_snd);
IFQ_SET_MAXLEN(&ifp->if_snd, TEMAC_TXQLEN);
sc->sc_ec.ec_capabilities |= ETHERCAP_VLAN_MTU;
if_attach(ifp);
ether_ifattach(ifp, enaddr);
sc->sc_sdhook = shutdownhook_establish(temac_shutdown, sc);
if (sc->sc_sdhook == NULL)
printf("%s: WARNING: unable to establish shutdown hook\n",
device_xname(self));
callout_setfunc(&sc->sc_mii_tick, temac_mii_tick, sc);
callout_setfunc(&sc->sc_rx_timo, temac_rxtimo, sc);
return ;
fail_6:
ll_dmac_intr_disestablish(rx->dmac_chan, sc->sc_rx_ih);
i = TEMAC_NRXDESC;
fail_5:
for (--i; i >= 0; i--)
bus_dmamap_destroy(sc->sc_dmat, sc->sc_rxsoft[i].rxs_dmap);
i = TEMAC_TXQLEN;
fail_4:
for (--i; i >= 0; i--)
bus_dmamap_destroy(sc->sc_dmat, sc->sc_txsoft[i].txs_dmap);
fail_3:
bus_dmamap_destroy(sc->sc_dmat, sc->sc_control_dmap);
fail_2:
bus_dmamem_unmap(sc->sc_dmat, (caddr_t)sc->sc_control_data,
sizeof(struct temac_control));
fail_1:
bus_dmamem_free(sc->sc_dmat, &seg, nseg);
fail_0:
printf("%s: error = %d\n", device_xname(self), error);
}
/*
* Network device.
*/
static int
temac_init(struct ifnet *ifp)
{
struct temac_softc *sc = (struct temac_softc *)ifp->if_softc;
uint32_t rcr, tcr;
int i, error;
/* Reset DMA channels. */
cdmac_tx_reset(sc);
cdmac_rx_reset(sc);
/* Set current media. */
mii_mediachg(&sc->sc_mii);
callout_schedule(&sc->sc_mii_tick, hz);
/* Enable EMAC engine. */
rcr = (gmi_read_4(TEMAC_GMI_RXCF1) | GMI_RX_ENABLE) &
~(GMI_RX_JUMBO | GMI_RX_FCS);
gmi_write_4(TEMAC_GMI_RXCF1, rcr);
tcr = (gmi_read_4(TEMAC_GMI_TXCF) | GMI_TX_ENABLE) &
~(GMI_TX_JUMBO | GMI_TX_FCS);
gmi_write_4(TEMAC_GMI_TXCF, tcr);
/* XXXFreza: Force promiscuous mode, for now. */
gmi_write_4(TEMAC_GMI_AFM, GMI_AFM_PROMISC);
ifp->if_flags |= IFF_PROMISC;
/* Rx/Tx queues are drained -- either from attach() or stop(). */
sc->sc_txsfree = TEMAC_TXQLEN;
sc->sc_txsreap = 0;
sc->sc_txscur = 0;
sc->sc_txfree = TEMAC_NTXDESC;
sc->sc_txreap = 0;
sc->sc_txcur = 0;
sc->sc_rxreap = 0;
/* Allocate and map receive buffers. */
if (sc->sc_rx_drained) {
for (i = 0; i < TEMAC_NRXDESC; i++) {
if ((error = temac_rxalloc(sc, i, 1)) != 0) {
printf("%s: failed to allocate Rx "
"descriptor %d\n",
sc->sc_dev.dv_xname, i);
temac_rxdrain(sc);
return (error);
}
}
sc->sc_rx_drained = 0;
temac_rxcdsync(sc, 0, TEMAC_NRXDESC,
BUS_DMASYNC_PREREAD|BUS_DMASYNC_PREWRITE);
cdmac_rx_start(sc, sc->sc_cdaddr + TEMAC_RXDOFF(0));
}
ifp->if_flags |= IFF_RUNNING;
ifp->if_flags &= ~IFF_OACTIVE;
return (0);
}
static int
temac_ioctl(struct ifnet *ifp, u_long cmd, caddr_t data)
{
struct temac_softc *sc = (struct temac_softc *)ifp->if_softc;
struct ifreq *ifr = (struct ifreq *)data;
int s, ret;
s = splnet();
if (sc->sc_dead) {
ret = EIO;
} else
switch (cmd) {
case SIOCSIFMEDIA:
case SIOCGIFMEDIA:
ret = ifmedia_ioctl(ifp, ifr, &sc->sc_mii.mii_media,
cmd);
break;
default:
ret = ether_ioctl(ifp, cmd, data);
break;
}
splx(s);
return (ret);
}
static void
temac_start(struct ifnet *ifp)
{
struct temac_softc *sc = (struct temac_softc *)ifp->if_softc;
struct temac_txsoft *txs;
struct mbuf *m;
bus_dmamap_t dmap;
int error, head, nsegs, i;
nsegs = 0;
head = sc->sc_txcur;
txs = NULL; /* gcc */
if (sc->sc_dead)
return;
KASSERT(sc->sc_txfree >= 0);
KASSERT(sc->sc_txsfree >= 0);
/*
* Push mbufs into descriptor chain until we drain the interface
* queue or run out of descriptors. We'll mark the first segment
* as "done" in hope that we might put CDMAC interrupt above IPL_NET
* and have it start jobs & mark packets for GC preemtively for
* us -- creativity due to limitations in CDMAC transfer engine
* (it really consumes lists, not circular queues, AFAICS).
*
* We schedule one interrupt per Tx batch.
*/
while (1) {
IFQ_POLL(&ifp->if_snd, m);
if (m == NULL)
break;
if (sc->sc_txsfree == 0) {
ifp->if_flags |= IFF_OACTIVE;
break;
}
txs = &sc->sc_txsoft[sc->sc_txscur];
dmap = txs->txs_dmap;
if (txs->txs_mbuf != NULL)
printf("FOO\n");
if (txs->txs_last)
printf("BAR\n");
if ((error = bus_dmamap_load_mbuf(sc->sc_dmat, dmap, m,
BUS_DMA_WRITE | BUS_DMA_NOWAIT)) != 0) {
if (error == EFBIG) {
printf("%s: Tx consumes too many segments, "
"dropped\n", sc->sc_dev.dv_xname);
IFQ_DEQUEUE(&ifp->if_snd, m);
m_freem(m);
continue;
} else {
printf("%s: Tx stall due to resource "
"shortage\n", sc->sc_dev.dv_xname);
break;
}
}
/*
* If we're short on DMA descriptors, notify upper layers
* and leave this packet for later.
*/
if (dmap->dm_nsegs > sc->sc_txfree) {
bus_dmamap_unload(sc->sc_dmat, dmap);
ifp->if_flags |= IFF_OACTIVE;
break;
}
IFQ_DEQUEUE(&ifp->if_snd, m);
bus_dmamap_sync(sc->sc_dmat, dmap, 0, dmap->dm_mapsize,
BUS_DMASYNC_PREWRITE);
txs->txs_mbuf = m;
/*
* Map the packet into descriptor chain. XXX We'll want
* to fill checksum offload commands here.
*
* We would be in a race if we weren't blocking CDMAC intr
* at this point -- we need to be locked against txreap()
* because of dmasync ops.
*/
temac_txcdsync(sc, sc->sc_txcur, dmap->dm_nsegs,
BUS_DMASYNC_POSTREAD|BUS_DMASYNC_POSTWRITE);
for (i = 0; i < dmap->dm_nsegs; i++) {
sc->sc_txdescs[sc->sc_txcur].desc_addr =
dmap->dm_segs[i].ds_addr;
sc->sc_txdescs[sc->sc_txcur].desc_size =
dmap->dm_segs[i].ds_len;
sc->sc_txdescs[sc->sc_txcur].desc_stat =
(i == 0 ? CDMAC_STAT_SOP : 0) |
(i == (dmap->dm_nsegs - 1) ? CDMAC_STAT_EOP : 0);
sc->sc_txcur = TEMAC_TXNEXT(sc->sc_txcur);
}
sc->sc_txfree -= dmap->dm_nsegs;
nsegs += dmap->dm_nsegs;
sc->sc_txscur = TEMAC_TXSNEXT(sc->sc_txscur);
sc->sc_txsfree--;
}
/* Get data running if we queued any. */
if (nsegs > 0) {
int tail = TEMAC_TXINC(sc->sc_txcur, -1);
/* Mark the last packet in this job. */
txs->txs_last = 1;
/* Mark the last descriptor in this job. */
sc->sc_txdescs[tail].desc_stat |= CDMAC_STAT_STOP |
CDMAC_STAT_INTR;
temac_txcdsync(sc, head, nsegs,
BUS_DMASYNC_PREREAD|BUS_DMASYNC_PREWRITE);
temac_txkick(sc);
#if TEMAC_TXDEBUG > 0
printf("%s: start: txcur %03d -> %03d, nseg %03d\n",
sc->sc_dev.dv_xname, head, sc->sc_txcur, nsegs);
#endif
}
}
static void
temac_stop(struct ifnet *ifp, int disable)
{
struct temac_softc *sc = (struct temac_softc *)ifp->if_softc;
struct temac_txsoft *txs;
int i;
#if TEMAC_DEBUG > 0
printf("%s: stop\n", device_xname(&sc->sc_dev));
#endif
/* Down the MII. */
callout_stop(&sc->sc_mii_tick);
mii_down(&sc->sc_mii);
/* Stop the engine. */
temac_reset(sc);
/* Drain buffers queues (unconditionally). */
temac_rxdrain(sc);
for (i = 0; i < TEMAC_TXQLEN; i++) {
txs = &sc->sc_txsoft[i];
if (txs->txs_mbuf != NULL) {
bus_dmamap_unload(sc->sc_dmat, txs->txs_dmap);
m_freem(txs->txs_mbuf);
txs->txs_mbuf = NULL;
txs->txs_last = 0;
}
}
sc->sc_txbusy = 0;
/* Acknowledge we're down. */
ifp->if_flags &= ~(IFF_RUNNING|IFF_OACTIVE);
}
/*
* Media management.
*/
static int
temac_mediachange(struct ifnet *ifp)
{
struct temac_softc *sc = (struct temac_softc *)ifp->if_softc;
if (ifp->if_flags & IFF_UP)
mii_mediachg(&sc->sc_mii);
return (0);
}
static void
temac_mediastatus(struct ifnet *ifp, struct ifmediareq *imr)
{
struct temac_softc *sc = (struct temac_softc *)ifp->if_softc;
mii_pollstat(&sc->sc_mii);
imr->ifm_status = sc->sc_mii.mii_media_status;
imr->ifm_active = sc->sc_mii.mii_media_active;
}
static int
temac_mii_readreg(struct device *self, int phy, int reg)
{
mtidcr(IDCR_HIF_ARG0, (phy << 5) | reg);
mtidcr(IDCR_HIF_CTRL, TEMAC_GMI_MII_ADDR);
hif_wait_stat(HIF_STAT_MIIRR);
return (int)mfidcr(IDCR_HIF_ARG0);
}
static void
temac_mii_writereg(struct device *self, int phy, int reg, int val)
{
mtidcr(IDCR_HIF_ARG0, val);
mtidcr(IDCR_HIF_CTRL, TEMAC_GMI_MII_WRVAL | HIF_CTRL_WRITE);
mtidcr(IDCR_HIF_ARG0, (phy << 5) | reg);
mtidcr(IDCR_HIF_CTRL, TEMAC_GMI_MII_ADDR | HIF_CTRL_WRITE);
hif_wait_stat(HIF_STAT_MIIWR);
}
static void
temac_mii_statchg(struct device *self)
{
struct temac_softc *sc = (struct temac_softc *)self;
uint32_t rcf, tcf, mmc;
/* Full/half duplex link. */
rcf = gmi_read_4(TEMAC_GMI_RXCF1);
tcf = gmi_read_4(TEMAC_GMI_TXCF);
if (sc->sc_mii.mii_media_active & IFM_FDX) {
gmi_write_4(TEMAC_GMI_RXCF1, rcf & ~GMI_RX_HDX);
gmi_write_4(TEMAC_GMI_TXCF, tcf & ~GMI_TX_HDX);
} else {
gmi_write_4(TEMAC_GMI_RXCF1, rcf | GMI_RX_HDX);
gmi_write_4(TEMAC_GMI_TXCF, tcf | GMI_TX_HDX);
}
/* Link speed. */
mmc = gmi_read_4(TEMAC_GMI_MMC) & ~GMI_MMC_SPEED_MASK;
switch (IFM_SUBTYPE(sc->sc_mii.mii_media_active)) {
case IFM_10_T:
/*
* XXXFreza: the GMAC is not happy with 10Mbit ethernet,
* although the documentation claims it's supported. Maybe
* it's just my equipment...
*/
mmc |= GMI_MMC_SPEED_10;
break;
case IFM_100_TX:
mmc |= GMI_MMC_SPEED_100;
break;
case IFM_1000_T:
mmc |= GMI_MMC_SPEED_1000;
break;
}
gmi_write_4(TEMAC_GMI_MMC, mmc);
}
static void
temac_mii_tick(void *arg)
{
struct temac_softc *sc = (struct temac_softc *)arg;
int s;
if ((sc->sc_dev.dv_flags & DVF_ACTIVE) == 0)
return ;
s = splnet();
mii_tick(&sc->sc_mii);
splx(s);
callout_schedule(&sc->sc_mii_tick, hz);
}
/*
* External hooks.
*/
static void
temac_shutdown(void *arg)
{
struct temac_softc *sc = (struct temac_softc *)arg;
temac_reset(sc);
}
static void
temac_tx_intr(void *arg)
{
struct temac_softc *sc = (struct temac_softc *)arg;
uint32_t stat;
/* XXX: We may need to splnet() here if cdmac(4) changes. */
if ((stat = cdmac_tx_stat(sc)) & CDMAC_STAT_ERROR) {
printf("%s: transmit DMA is toast (%#08x), halted!\n",
sc->sc_dev.dv_xname, stat);
/* XXXFreza: how to signal this upstream? */
temac_stop(&sc->sc_if, 1);
sc->sc_dead = 1;
}
#if TEMAC_DEBUG > 0
printf("%s: tx intr 0x%08x\n", device_xname(&sc->sc_dev), stat);
#endif
temac_txreap(sc);
}
static void
temac_rx_intr(void *arg)
{
struct temac_softc *sc = (struct temac_softc *)arg;
uint32_t stat;
/* XXX: We may need to splnet() here if cdmac(4) changes. */
if ((stat = cdmac_rx_stat(sc)) & CDMAC_STAT_ERROR) {
printf("%s: receive DMA is toast (%#08x), halted!\n",
sc->sc_dev.dv_xname, stat);
/* XXXFreza: how to signal this upstream? */
temac_stop(&sc->sc_if, 1);
sc->sc_dead = 1;
}
#if TEMAC_DEBUG > 0
printf("%s: rx intr 0x%08x\n", device_xname(&sc->sc_dev), stat);
#endif
temac_rxreap(sc);
}
/*
* Utils.
*/
static inline void
temac_txcdsync(struct temac_softc *sc, int first, int cnt, int flag)
{
if ((first + cnt) > TEMAC_NTXDESC) {
bus_dmamap_sync(sc->sc_dmat, sc->sc_control_dmap,
TEMAC_TXDOFF(first),
sizeof(struct cdmac_descr) * (TEMAC_NTXDESC - first),
flag);
cnt = (first + cnt) % TEMAC_NTXDESC;
first = 0;
}
bus_dmamap_sync(sc->sc_dmat, sc->sc_control_dmap,
TEMAC_TXDOFF(first),
sizeof(struct cdmac_descr) * cnt,
flag);
}
static inline void
temac_rxcdsync(struct temac_softc *sc, int first, int cnt, int flag)
{
if ((first + cnt) > TEMAC_NRXDESC) {
bus_dmamap_sync(sc->sc_dmat, sc->sc_control_dmap,
TEMAC_RXDOFF(first),
sizeof(struct cdmac_descr) * (TEMAC_NRXDESC - first),
flag);
cnt = (first + cnt) % TEMAC_NRXDESC;
first = 0;
}
bus_dmamap_sync(sc->sc_dmat, sc->sc_control_dmap,
TEMAC_RXDOFF(first),
sizeof(struct cdmac_descr) * cnt,
flag);
}
static void
temac_txreap(struct temac_softc *sc)
{
struct temac_txsoft *txs;
bus_dmamap_t dmap;
int sent = 0;
/*
* Transmit interrupts happen on the last descriptor of Tx jobs.
* Hence, every time we're called (and we assume txintr is our
* only caller!), we reap packets upto and including the one
* marked as last-in-batch.
*
* XXX we rely on that we make EXACTLY one batch per intr, no more
*/
while (sc->sc_txsfree != TEMAC_TXQLEN) {
txs = &sc->sc_txsoft[sc->sc_txsreap];
dmap = txs->txs_dmap;
sc->sc_txreap = TEMAC_TXINC(sc->sc_txreap, dmap->dm_nsegs);
sc->sc_txfree += dmap->dm_nsegs;
bus_dmamap_unload(sc->sc_dmat, txs->txs_dmap);
m_freem(txs->txs_mbuf);
txs->txs_mbuf = NULL;
sc->sc_if.if_opackets++;
sent = 1;
sc->sc_txsreap = TEMAC_TXSNEXT(sc->sc_txsreap);
sc->sc_txsfree++;
if (txs->txs_last) {
txs->txs_last = 0;
sc->sc_txbusy = 0; /* channel stopped now */
temac_txkick(sc);
break;
}
}
if (sent && (sc->sc_if.if_flags & IFF_OACTIVE))
sc->sc_if.if_flags &= ~IFF_OACTIVE;
}
static int
temac_rxalloc(struct temac_softc *sc, int which, int verbose)
{
struct temac_rxsoft *rxs;
struct mbuf *m;
uint32_t stat;
int error;
rxs = &sc->sc_rxsoft[which];
/* The mbuf itself is not our problem, just clear DMA related stuff. */
if (rxs->rxs_mbuf != NULL) {
bus_dmamap_unload(sc->sc_dmat, rxs->rxs_dmap);
rxs->rxs_mbuf = NULL;
}
/*
* We would like to store mbuf and dmap in application specific
* fields of the descriptor, but that doesn't work for Rx. Shame
* on Xilinx for this (and for the useless timer architecture).
*
* Hence each descriptor needs its own soft state. We may want
* to merge multiple rxs's into a monster mbuf when we support
* jumbo frames though. Also, we use single set of indexing
* variables for both sc_rxdescs[] and sc_rxsoft[].
*/
MGETHDR(m, M_DONTWAIT, MT_DATA);
if (m == NULL) {
if (verbose)
printf("%s: out of Rx header mbufs\n",
sc->sc_dev.dv_xname);
return (ENOBUFS);
}
MCLAIM(m, &sc->sc_ec.ec_rx_mowner);
MCLGET(m, M_DONTWAIT);
if ((m->m_flags & M_EXT) == 0) {
if (verbose)
printf("%s: out of Rx cluster mbufs\n",
sc->sc_dev.dv_xname);
m_freem(m);
return (ENOBUFS);
}
rxs->rxs_mbuf = m;
m->m_pkthdr.len = m->m_len = MCLBYTES;
/* Make sure the payload after ethernet header is 4-aligned. */
m_adj(m, 2);
error = bus_dmamap_load_mbuf(sc->sc_dmat, rxs->rxs_dmap, m,
BUS_DMA_NOWAIT);
if (error) {
if (verbose)
printf("%s: could not map Rx descriptor %d, "
"error = %d\n", sc->sc_dev.dv_xname, which, error);
rxs->rxs_mbuf = NULL;
m_freem(m);
return (error);
}
stat = \
(TEMAC_ISINTR(which) ? CDMAC_STAT_INTR : 0) |
(TEMAC_ISLAST(which) ? CDMAC_STAT_STOP : 0);
bus_dmamap_sync(sc->sc_dmat, rxs->rxs_dmap, 0,
rxs->rxs_dmap->dm_mapsize, BUS_DMASYNC_PREREAD);
/* Descriptor post-sync, if needed, left to the caller. */
sc->sc_rxdescs[which].desc_addr = rxs->rxs_dmap->dm_segs[0].ds_addr;
sc->sc_rxdescs[which].desc_size = rxs->rxs_dmap->dm_segs[0].ds_len;
sc->sc_rxdescs[which].desc_stat = stat;
/* Descriptor pre-sync, if needed, left to the caller. */
return (0);
}
static void
temac_rxreap(struct temac_softc *sc)
{
struct ifnet *ifp = &sc->sc_if;
uint32_t stat, rxstat, rxsize;
struct mbuf *m;
int nseg, head, tail;
head = sc->sc_rxreap;
tail = 0; /* gcc */
nseg = 0;
/*
* Collect finished entries on the Rx list, kick DMA if we hit
* the end. DMA will always stop on the last descriptor in chain,
* so it will never hit a reap-in-progress descriptor.
*/
while (1) {
/* Maybe we previously failed to refresh this one? */
if (sc->sc_rxsoft[sc->sc_rxreap].rxs_mbuf == NULL) {
if (temac_rxalloc(sc, sc->sc_rxreap, 0) != 0)
break;
sc->sc_rxreap = TEMAC_RXNEXT(sc->sc_rxreap);
continue;
}
temac_rxcdsync(sc, sc->sc_rxreap, 1,
BUS_DMASYNC_POSTREAD|BUS_DMASYNC_POSTWRITE);
stat = sc->sc_rxdescs[sc->sc_rxreap].desc_stat;
m = NULL;
if ((stat & CDMAC_STAT_DONE) == 0)
break;
/* Count any decriptor we've collected, regardless of status. */
nseg ++;
/* XXXFreza: This won't work for jumbo frames. */
if ((stat & (CDMAC_STAT_EOP | CDMAC_STAT_SOP)) !=
(CDMAC_STAT_EOP | CDMAC_STAT_SOP)) {
printf("%s: Rx packet doesn't fit in "
"one descriptor, stat = %#08x\n",
sc->sc_dev.dv_xname, stat);
goto badframe;
}
/* Dissect TEMAC footer if this is end of packet. */
rxstat = sc->sc_rxdescs[sc->sc_rxreap].desc_rxstat;
rxsize = sc->sc_rxdescs[sc->sc_rxreap].desc_rxsize &
RXSIZE_MASK;
if ((rxstat & RXSTAT_GOOD) == 0 ||
(rxstat & RXSTAT_SICK) != 0) {
printf("%s: corrupt Rx packet, rxstat = %#08x\n",
sc->sc_dev.dv_xname, rxstat);
goto badframe;
}
/* We are now bound to succeed. */
bus_dmamap_sync(sc->sc_dmat,
sc->sc_rxsoft[sc->sc_rxreap].rxs_dmap, 0,
sc->sc_rxsoft[sc->sc_rxreap].rxs_dmap->dm_mapsize,
BUS_DMASYNC_POSTREAD);
m = sc->sc_rxsoft[sc->sc_rxreap].rxs_mbuf;
m->m_pkthdr.rcvif = ifp;
m->m_pkthdr.len = m->m_len = rxsize;
badframe:
/* Get ready for more work. */
tail = sc->sc_rxreap;
sc->sc_rxreap = TEMAC_RXNEXT(sc->sc_rxreap);
/* On failures we reuse the descriptor and go ahead. */
if (m == NULL) {
sc->sc_rxdescs[tail].desc_stat =
(TEMAC_ISINTR(tail) ? CDMAC_STAT_INTR : 0) |
(TEMAC_ISLAST(tail) ? CDMAC_STAT_STOP : 0);
ifp->if_ierrors++;
continue;
}
#if NBPFILTER > 0
if (ifp->if_bpf != NULL)
bpf_mtap(ifp->if_bpf, m);
#endif
ifp->if_ipackets++;
(ifp->if_input)(ifp, m);
/* Refresh descriptor, bail out if we're out of buffers. */
if (temac_rxalloc(sc, tail, 1) != 0) {
sc->sc_rxreap = TEMAC_RXINC(sc->sc_rxreap, -1);
printf("%s: Rx give up for now\n", sc->sc_dev.dv_xname);
break;
}
}
/* We may now have a contiguous ready-to-go chunk of descriptors. */
if (nseg > 0) {
#if TEMAC_RXDEBUG > 0
printf("%s: rxreap: rxreap %03d -> %03d, nseg %03d\n",
sc->sc_dev.dv_xname, head, sc->sc_rxreap, nseg);
#endif
temac_rxcdsync(sc, head, nseg,
BUS_DMASYNC_PREREAD|BUS_DMASYNC_PREWRITE);
if (TEMAC_ISLAST(tail))
cdmac_rx_start(sc, sc->sc_cdaddr + TEMAC_RXDOFF(0));
}
/* Ensure maximum Rx latency is kept under control. */
callout_schedule(&sc->sc_rx_timo, hz / TEMAC_RXTIMO_HZ);
}
static void
temac_rxtimo(void *arg)
{
struct temac_softc *sc = (struct temac_softc *)arg;
int s;
/* We run TEMAC_RXTIMO_HZ times/sec to ensure Rx doesn't stall. */
s = splnet();
temac_rxreap(sc);
splx(s);
}
static void
temac_reset(struct temac_softc *sc)
{
uint32_t rcr, tcr;
/* Kill CDMAC channels. */
cdmac_tx_reset(sc);
cdmac_rx_reset(sc);
/* Disable receiver. */
rcr = gmi_read_4(TEMAC_GMI_RXCF1) & ~GMI_RX_ENABLE;
gmi_write_4(TEMAC_GMI_RXCF1, rcr);
/* Disable transmitter. */
tcr = gmi_read_4(TEMAC_GMI_TXCF) & ~GMI_TX_ENABLE;
gmi_write_4(TEMAC_GMI_TXCF, tcr);
}
static void
temac_rxdrain(struct temac_softc *sc)
{
struct temac_rxsoft *rxs;
int i;
for (i = 0; i < TEMAC_NRXDESC; i++) {
rxs = &sc->sc_rxsoft[i];
if (rxs->rxs_mbuf != NULL) {
bus_dmamap_unload(sc->sc_dmat, rxs->rxs_dmap);
m_freem(rxs->rxs_mbuf);
rxs->rxs_mbuf = NULL;
}
}
sc->sc_rx_drained = 1;
}
static void
temac_txkick(struct temac_softc *sc)
{
if (sc->sc_txsoft[sc->sc_txsreap].txs_mbuf != NULL &&
sc->sc_txbusy == 0) {
cdmac_tx_start(sc, sc->sc_cdaddr + TEMAC_TXDOFF(sc->sc_txreap));
sc->sc_txbusy = 1;
}
}