Home | History | Annotate | Line # | Download | only in ep93xx
epe.c revision 1.7
      1  1.7   thorpej /*	$NetBSD: epe.c,v 1.7 2006/03/29 04:16:45 thorpej Exp $	*/
      2  1.1      joff 
      3  1.1      joff /*
      4  1.1      joff  * Copyright (c) 2004 Jesse Off
      5  1.1      joff  * All rights reserved.
      6  1.1      joff  *
      7  1.1      joff  * Redistribution and use in source and binary forms, with or without
      8  1.1      joff  * modification, are permitted provided that the following conditions
      9  1.1      joff  * are met:
     10  1.1      joff  * 1. Redistributions of source code must retain the above copyright
     11  1.1      joff  *    notice, this list of conditions and the following disclaimer.
     12  1.1      joff  * 2. Redistributions in binary form must reproduce the above copyright
     13  1.1      joff  *    notice, this list of conditions and the following disclaimer in the
     14  1.1      joff  *    documentation and/or other materials provided with the distribution.
     15  1.1      joff  * 3. All advertising materials mentioning features or use of this software
     16  1.1      joff  *    must display the following acknowledgement:
     17  1.1      joff  *	This product includes software developed by the NetBSD
     18  1.1      joff  *	Foundation, Inc. and its contributors.
     19  1.1      joff  * 4. Neither the name of The NetBSD Foundation nor the names of its
     20  1.1      joff  *    contributors may be used to endorse or promote products derived
     21  1.1      joff  *    from this software without specific prior written permission.
     22  1.1      joff  *
     23  1.1      joff  * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
     24  1.1      joff  * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
     25  1.1      joff  * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
     26  1.1      joff  * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
     27  1.1      joff  * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
     28  1.1      joff  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
     29  1.1      joff  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
     30  1.1      joff  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
     31  1.1      joff  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
     32  1.1      joff  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
     33  1.1      joff  * POSSIBILITY OF SUCH DAMAGE.
     34  1.1      joff  */
     35  1.1      joff 
     36  1.1      joff #include <sys/cdefs.h>
     37  1.7   thorpej __KERNEL_RCSID(0, "$NetBSD: epe.c,v 1.7 2006/03/29 04:16:45 thorpej Exp $");
     38  1.1      joff 
     39  1.1      joff #include <sys/types.h>
     40  1.1      joff #include <sys/param.h>
     41  1.1      joff #include <sys/systm.h>
     42  1.1      joff #include <sys/ioctl.h>
     43  1.1      joff #include <sys/kernel.h>
     44  1.1      joff #include <sys/proc.h>
     45  1.1      joff #include <sys/malloc.h>
     46  1.1      joff #include <sys/time.h>
     47  1.1      joff #include <sys/device.h>
     48  1.1      joff #include <uvm/uvm_extern.h>
     49  1.1      joff 
     50  1.1      joff #include <machine/bus.h>
     51  1.1      joff #include <machine/intr.h>
     52  1.1      joff 
     53  1.1      joff #include <arm/cpufunc.h>
     54  1.1      joff 
     55  1.1      joff #include <arm/ep93xx/epsocvar.h>
     56  1.1      joff #include <arm/ep93xx/ep93xxvar.h>
     57  1.1      joff 
     58  1.1      joff #include <net/if.h>
     59  1.1      joff #include <net/if_dl.h>
     60  1.1      joff #include <net/if_types.h>
     61  1.1      joff #include <net/if_media.h>
     62  1.1      joff #include <net/if_ether.h>
     63  1.1      joff 
     64  1.1      joff #include <dev/mii/mii.h>
     65  1.1      joff #include <dev/mii/miivar.h>
     66  1.1      joff 
     67  1.1      joff #ifdef INET
     68  1.1      joff #include <netinet/in.h>
     69  1.1      joff #include <netinet/in_systm.h>
     70  1.1      joff #include <netinet/in_var.h>
     71  1.1      joff #include <netinet/ip.h>
     72  1.1      joff #include <netinet/if_inarp.h>
     73  1.1      joff #endif
     74  1.1      joff 
     75  1.1      joff #ifdef NS
     76  1.1      joff #include <netns/ns.h>
     77  1.1      joff #include <netns/ns_if.h>
     78  1.1      joff #endif
     79  1.1      joff 
     80  1.1      joff #include "bpfilter.h"
     81  1.1      joff #if NBPFILTER > 0
     82  1.1      joff #include <net/bpf.h>
     83  1.1      joff #include <net/bpfdesc.h>
     84  1.1      joff #endif
     85  1.1      joff 
     86  1.1      joff #include <machine/bus.h>
     87  1.1      joff 
     88  1.1      joff #ifdef IPKDB_EP93XX
     89  1.1      joff #include <ipkdb/ipkdb.h>
     90  1.1      joff #endif
     91  1.1      joff 
     92  1.2      joff #include <arm/ep93xx/ep93xxreg.h>
     93  1.1      joff #include <arm/ep93xx/epereg.h>
     94  1.1      joff #include <arm/ep93xx/epevar.h>
     95  1.1      joff 
     96  1.4  hamajima #define DEFAULT_MDCDIV	32
     97  1.4  hamajima 
     98  1.2      joff #ifndef EPE_FAST
     99  1.2      joff #define EPE_FAST
    100  1.2      joff #endif
    101  1.1      joff 
    102  1.2      joff #ifndef EPE_FAST
    103  1.1      joff #define EPE_READ(x) \
    104  1.1      joff 	bus_space_read_4(sc->sc_iot, sc->sc_ioh, (EPE_ ## x))
    105  1.1      joff #define EPE_WRITE(x, y) \
    106  1.1      joff 	bus_space_write_4(sc->sc_iot, sc->sc_ioh, (EPE_ ## x), (y))
    107  1.2      joff #define CTRLPAGE_DMASYNC(x, y, z) \
    108  1.2      joff 	bus_dmamap_sync(sc->sc_dmat, sc->ctrlpage_dmamap, (x), (y), (z))
    109  1.2      joff #else
    110  1.5     perry #define EPE_READ(x) *(volatile u_int32_t *) \
    111  1.2      joff 	(EP93XX_AHB_VBASE + EP93XX_AHB_EPE + (EPE_ ## x))
    112  1.5     perry #define EPE_WRITE(x, y) *(volatile u_int32_t *) \
    113  1.2      joff 	(EP93XX_AHB_VBASE + EP93XX_AHB_EPE + (EPE_ ## x)) = y
    114  1.2      joff #define CTRLPAGE_DMASYNC(x, y, z)
    115  1.2      joff #endif /* ! EPE_FAST */
    116  1.1      joff 
    117  1.1      joff static int	epe_match(struct device *, struct cfdata *, void *);
    118  1.1      joff static void	epe_attach(struct device *, struct device *, void *);
    119  1.1      joff static void	epe_init(struct epe_softc *);
    120  1.1      joff static int      epe_intr(void* arg);
    121  1.2      joff static int	epe_gctx(struct epe_softc *);
    122  1.1      joff static int	epe_mediachange(struct ifnet *);
    123  1.1      joff static void	epe_mediastatus(struct ifnet *, struct ifmediareq *);
    124  1.1      joff int		epe_mii_readreg (struct device *, int, int);
    125  1.1      joff void		epe_mii_writereg (struct device *, int, int, int);
    126  1.1      joff void		epe_statchg (struct device *);
    127  1.1      joff void		epe_tick (void *);
    128  1.1      joff static int	epe_ifioctl (struct ifnet *, u_long, caddr_t);
    129  1.1      joff static void	epe_ifstart (struct ifnet *);
    130  1.1      joff static void	epe_ifwatchdog (struct ifnet *);
    131  1.1      joff static int	epe_ifinit (struct ifnet *);
    132  1.1      joff static void	epe_ifstop (struct ifnet *, int);
    133  1.1      joff static void	epe_setaddr (struct ifnet *);
    134  1.1      joff 
    135  1.1      joff CFATTACH_DECL(epe, sizeof(struct epe_softc),
    136  1.1      joff     epe_match, epe_attach, NULL, NULL);
    137  1.1      joff 
    138  1.1      joff static int
    139  1.1      joff epe_match(struct device *parent, struct cfdata *match, void *aux)
    140  1.1      joff {
    141  1.1      joff 	return 2;
    142  1.1      joff }
    143  1.1      joff 
    144  1.1      joff static void
    145  1.1      joff epe_attach(struct device *parent, struct device *self, void *aux)
    146  1.1      joff {
    147  1.1      joff 	struct epe_softc		*sc;
    148  1.1      joff 	struct epsoc_attach_args	*sa;
    149  1.1      joff 
    150  1.1      joff 	printf("\n");
    151  1.1      joff 	sc = (struct epe_softc*) self;
    152  1.1      joff 	sa = aux;
    153  1.1      joff 	sc->sc_iot = sa->sa_iot;
    154  1.1      joff 	sc->sc_intr = sa->sa_intr;
    155  1.1      joff 	sc->sc_dmat = sa->sa_dmat;
    156  1.1      joff 
    157  1.1      joff 	if (bus_space_map(sa->sa_iot, sa->sa_addr, sa->sa_size,
    158  1.1      joff 		0, &sc->sc_ioh))
    159  1.1      joff 		panic("%s: Cannot map registers", self->dv_xname);
    160  1.1      joff 
    161  1.4  hamajima 	/* Fetch the Ethernet address from property if set. */
    162  1.6   thorpej 	if (devprop_get(self, "mac-addr", sc->sc_enaddr,
    163  1.4  hamajima 		       ETHER_ADDR_LEN, NULL) == ETHER_ADDR_LEN) {
    164  1.4  hamajima 		bus_space_write_4(sc->sc_iot, sc->sc_ioh, EPE_AFP, 0);
    165  1.4  hamajima 		bus_space_write_region_1(sc->sc_iot, sc->sc_ioh, EPE_IndAd,
    166  1.4  hamajima 					 sc->sc_enaddr, ETHER_ADDR_LEN);
    167  1.4  hamajima 	}
    168  1.4  hamajima 
    169  1.1      joff         ep93xx_intr_establish(sc->sc_intr, IPL_NET, epe_intr, sc);
    170  1.1      joff 	epe_init(sc);
    171  1.1      joff }
    172  1.1      joff 
    173  1.1      joff static int
    174  1.2      joff epe_gctx(struct epe_softc *sc)
    175  1.2      joff {
    176  1.2      joff 	struct ifnet * ifp = &sc->sc_ec.ec_if;
    177  1.2      joff 	u_int32_t *cur, ndq = 0;
    178  1.2      joff 
    179  1.2      joff 	/* Handle transmit completions */
    180  1.2      joff 	cur = (u_int32_t *)(EPE_READ(TXStsQCurAdd) -
    181  1.2      joff 		sc->ctrlpage_dsaddr + sc->ctrlpage);
    182  1.2      joff 
    183  1.2      joff 	if (sc->TXStsQ_cur != cur) {
    184  1.2      joff 		CTRLPAGE_DMASYNC(TX_QLEN * 2 * sizeof(u_int32_t),
    185  1.2      joff 			TX_QLEN * sizeof(u_int32_t), BUS_DMASYNC_PREREAD);
    186  1.2      joff 	} else {
    187  1.2      joff 		return 0;
    188  1.2      joff 	}
    189  1.2      joff 
    190  1.2      joff 	do {
    191  1.2      joff 		u_int32_t tbi = *sc->TXStsQ_cur & 0x7fff;
    192  1.2      joff 		struct mbuf *m = sc->txq[tbi].m;
    193  1.2      joff 
    194  1.2      joff 		if ((*sc->TXStsQ_cur & TXStsQ_TxWE) == 0) {
    195  1.2      joff 			ifp->if_oerrors++;
    196  1.2      joff 		}
    197  1.2      joff 		bus_dmamap_unload(sc->sc_dmat, sc->txq[tbi].m_dmamap);
    198  1.2      joff 		m_freem(m);
    199  1.2      joff 		do {
    200  1.2      joff 			sc->txq[tbi].m = NULL;
    201  1.2      joff 			ndq++;
    202  1.2      joff 			tbi = (tbi + 1) % TX_QLEN;
    203  1.2      joff 		} while (sc->txq[tbi].m == m);
    204  1.2      joff 
    205  1.2      joff 		ifp->if_opackets++;
    206  1.2      joff 		sc->TXStsQ_cur++;
    207  1.2      joff 		if (sc->TXStsQ_cur >= sc->TXStsQ + TX_QLEN) {
    208  1.2      joff 			sc->TXStsQ_cur = sc->TXStsQ;
    209  1.2      joff 		}
    210  1.2      joff 	} while (sc->TXStsQ_cur != cur);
    211  1.2      joff 
    212  1.2      joff 	sc->TXDQ_avail += ndq;
    213  1.2      joff 	if (ifp->if_flags & IFF_OACTIVE) {
    214  1.2      joff 		ifp->if_flags &= ~IFF_OACTIVE;
    215  1.2      joff 		/* Disable end-of-tx-chain interrupt */
    216  1.2      joff 		EPE_WRITE(IntEn, IntEn_REOFIE);
    217  1.2      joff 	}
    218  1.2      joff 	return ndq;
    219  1.2      joff }
    220  1.2      joff 
    221  1.2      joff static int
    222  1.1      joff epe_intr(void *arg)
    223  1.1      joff {
    224  1.1      joff 	struct epe_softc *sc = (struct epe_softc *)arg;
    225  1.1      joff 	struct ifnet * ifp = &sc->sc_ec.ec_if;
    226  1.1      joff 	u_int32_t ndq = 0, irq, *cur;
    227  1.1      joff 
    228  1.1      joff 	irq = EPE_READ(IntStsC);
    229  1.1      joff begin:
    230  1.1      joff 	cur = (u_int32_t *)(EPE_READ(RXStsQCurAdd) -
    231  1.2      joff 		sc->ctrlpage_dsaddr + sc->ctrlpage);
    232  1.2      joff 	CTRLPAGE_DMASYNC(TX_QLEN * 3 * sizeof(u_int32_t),
    233  1.1      joff 		RX_QLEN * 4 * sizeof(u_int32_t),
    234  1.1      joff 		BUS_DMASYNC_PREREAD);
    235  1.1      joff 	while (sc->RXStsQ_cur != cur) {
    236  1.1      joff 		if ((sc->RXStsQ_cur[0] & (RXStsQ_RWE|RXStsQ_RFP|RXStsQ_EOB)) ==
    237  1.1      joff 			(RXStsQ_RWE|RXStsQ_RFP|RXStsQ_EOB)) {
    238  1.1      joff 			u_int32_t bi = (sc->RXStsQ_cur[1] >> 16) & 0x7fff;
    239  1.1      joff 			u_int32_t fl = sc->RXStsQ_cur[1] & 0xffff;
    240  1.1      joff 			struct mbuf *m;
    241  1.1      joff 
    242  1.1      joff 			MGETHDR(m, M_DONTWAIT, MT_DATA);
    243  1.1      joff 			if (m != NULL) MCLGET(m, M_DONTWAIT);
    244  1.1      joff 			if (m != NULL && (m->m_flags & M_EXT)) {
    245  1.1      joff 				bus_dmamap_unload(sc->sc_dmat,
    246  1.1      joff 					sc->rxq[bi].m_dmamap);
    247  1.1      joff 				sc->rxq[bi].m->m_pkthdr.rcvif = ifp;
    248  1.1      joff 				sc->rxq[bi].m->m_pkthdr.len =
    249  1.1      joff 					sc->rxq[bi].m->m_len = fl;
    250  1.1      joff #if NBPFILTER > 0
    251  1.1      joff 				if (ifp->if_bpf)
    252  1.1      joff 					bpf_mtap(ifp->if_bpf, sc->rxq[bi].m);
    253  1.1      joff #endif /* NBPFILTER > 0 */
    254  1.1      joff                                 (*ifp->if_input)(ifp, sc->rxq[bi].m);
    255  1.1      joff 				sc->rxq[bi].m = m;
    256  1.1      joff 				bus_dmamap_load(sc->sc_dmat,
    257  1.1      joff 					sc->rxq[bi].m_dmamap,
    258  1.1      joff 					m->m_ext.ext_buf, MCLBYTES,
    259  1.1      joff 					NULL, BUS_DMA_NOWAIT);
    260  1.1      joff 				sc->RXDQ[bi * 2] =
    261  1.1      joff 					sc->rxq[bi].m_dmamap->dm_segs[0].ds_addr;
    262  1.1      joff 			} else {
    263  1.1      joff 				/* Drop packets until we can get replacement
    264  1.1      joff 				 * empty mbufs for the RXDQ.
    265  1.1      joff 				 */
    266  1.1      joff 				if (m != NULL) {
    267  1.1      joff 					m_freem(m);
    268  1.1      joff 				}
    269  1.1      joff 				ifp->if_ierrors++;
    270  1.1      joff 			}
    271  1.1      joff 		} else {
    272  1.1      joff 			ifp->if_ierrors++;
    273  1.1      joff 		}
    274  1.1      joff 
    275  1.1      joff 		ndq++;
    276  1.1      joff 
    277  1.1      joff 		sc->RXStsQ_cur += 2;
    278  1.1      joff 		if (sc->RXStsQ_cur >= sc->RXStsQ + (RX_QLEN * 2)) {
    279  1.1      joff 			sc->RXStsQ_cur = sc->RXStsQ;
    280  1.1      joff 		}
    281  1.1      joff 	}
    282  1.1      joff 
    283  1.1      joff 	if (ndq > 0) {
    284  1.1      joff 		ifp->if_ipackets += ndq;
    285  1.2      joff 		CTRLPAGE_DMASYNC(TX_QLEN * 3 * sizeof(u_int32_t),
    286  1.1      joff  			RX_QLEN * 4 * sizeof(u_int32_t),
    287  1.1      joff 			BUS_DMASYNC_PREWRITE|BUS_DMASYNC_PREREAD);
    288  1.1      joff 		EPE_WRITE(RXStsEnq, ndq);
    289  1.1      joff 		EPE_WRITE(RXDEnq, ndq);
    290  1.1      joff 		ndq = 0;
    291  1.1      joff 	}
    292  1.1      joff 
    293  1.2      joff 	if (epe_gctx(sc) > 0 && IFQ_IS_EMPTY(&ifp->if_snd) == 0) {
    294  1.2      joff 		epe_ifstart(ifp);
    295  1.2      joff 	}
    296  1.1      joff 
    297  1.1      joff 	irq = EPE_READ(IntStsC);
    298  1.2      joff 	if ((irq & (IntSts_RxSQ|IntSts_ECI)) != 0)
    299  1.1      joff 		goto begin;
    300  1.2      joff 
    301  1.1      joff 	return (1);
    302  1.1      joff }
    303  1.1      joff 
    304  1.1      joff 
    305  1.1      joff static void
    306  1.1      joff epe_init(struct epe_softc *sc)
    307  1.1      joff {
    308  1.1      joff 	bus_dma_segment_t segs;
    309  1.1      joff 	caddr_t addr;
    310  1.1      joff 	int rsegs, err, i;
    311  1.1      joff 	struct ifnet * ifp = &sc->sc_ec.ec_if;
    312  1.4  hamajima 	int mdcdiv = DEFAULT_MDCDIV;
    313  1.1      joff 
    314  1.1      joff 	callout_init(&sc->epe_tick_ch);
    315  1.1      joff 
    316  1.1      joff 	/* Select primary Individual Address in Address Filter Pointer */
    317  1.1      joff 	EPE_WRITE(AFP, 0);
    318  1.1      joff 	/* Read ethernet MAC, should already be set by bootrom */
    319  1.1      joff 	bus_space_read_region_1(sc->sc_iot, sc->sc_ioh, EPE_IndAd,
    320  1.1      joff 		sc->sc_enaddr, ETHER_ADDR_LEN);
    321  1.1      joff 	printf("%s: MAC address %s\n", sc->sc_dev.dv_xname,
    322  1.1      joff 		ether_sprintf(sc->sc_enaddr));
    323  1.1      joff 
    324  1.1      joff 	/* Soft Reset the MAC */
    325  1.1      joff 	EPE_WRITE(SelfCtl, SelfCtl_RESET);
    326  1.1      joff 	while(EPE_READ(SelfCtl) & SelfCtl_RESET);
    327  1.1      joff 
    328  1.1      joff 	/* suggested magic initialization values from datasheet */
    329  1.1      joff 	EPE_WRITE(RXBufThrshld, 0x800040);
    330  1.1      joff 	EPE_WRITE(TXBufThrshld, 0x200010);
    331  1.1      joff 	EPE_WRITE(RXStsThrshld, 0x40002);
    332  1.1      joff 	EPE_WRITE(TXStsThrshld, 0x40002);
    333  1.1      joff 	EPE_WRITE(RXDThrshld, 0x40002);
    334  1.1      joff 	EPE_WRITE(TXDThrshld, 0x40002);
    335  1.1      joff 
    336  1.1      joff 	/* Allocate a page of memory for descriptor and status queues */
    337  1.1      joff 	err = bus_dmamem_alloc(sc->sc_dmat, PAGE_SIZE, 0, PAGE_SIZE,
    338  1.1      joff 		&segs, 1, &rsegs, BUS_DMA_WAITOK);
    339  1.1      joff 	if (err == 0) {
    340  1.1      joff 		err = bus_dmamem_map(sc->sc_dmat, &segs, 1, PAGE_SIZE,
    341  1.2      joff 			&sc->ctrlpage, (BUS_DMA_WAITOK|BUS_DMA_COHERENT));
    342  1.1      joff 	}
    343  1.1      joff 	if (err == 0) {
    344  1.1      joff 		err = bus_dmamap_create(sc->sc_dmat, PAGE_SIZE, 1, PAGE_SIZE,
    345  1.1      joff 			0, BUS_DMA_WAITOK, &sc->ctrlpage_dmamap);
    346  1.1      joff 	}
    347  1.1      joff 	if (err == 0) {
    348  1.1      joff 		err = bus_dmamap_load(sc->sc_dmat, sc->ctrlpage_dmamap,
    349  1.1      joff 			sc->ctrlpage, PAGE_SIZE, NULL, BUS_DMA_WAITOK);
    350  1.1      joff 	}
    351  1.1      joff 	if (err != 0) {
    352  1.1      joff 		panic("%s: Cannot get DMA memory", sc->sc_dev.dv_xname);
    353  1.1      joff 	}
    354  1.2      joff 	sc->ctrlpage_dsaddr = sc->ctrlpage_dmamap->dm_segs[0].ds_addr;
    355  1.1      joff 	bzero(sc->ctrlpage, PAGE_SIZE);
    356  1.1      joff 
    357  1.1      joff 	/* Set up pointers to start of each queue in kernel addr space.
    358  1.1      joff 	 * Each descriptor queue or status queue entry uses 2 words
    359  1.1      joff 	 */
    360  1.1      joff 	sc->TXDQ = (u_int32_t *)sc->ctrlpage;
    361  1.1      joff 	sc->TXDQ_cur = sc->TXDQ;
    362  1.1      joff 	sc->TXDQ_avail = TX_QLEN - 1;
    363  1.1      joff 	sc->TXStsQ = &sc->TXDQ[TX_QLEN * 2];
    364  1.1      joff 	sc->TXStsQ_cur = sc->TXStsQ;
    365  1.1      joff 	sc->RXDQ = &sc->TXStsQ[TX_QLEN];
    366  1.1      joff 	sc->RXStsQ = &sc->RXDQ[RX_QLEN * 2];
    367  1.1      joff 	sc->RXStsQ_cur = sc->RXStsQ;
    368  1.1      joff 
    369  1.1      joff 	/* Program each queue's start addr, cur addr, and len registers
    370  1.1      joff 	 * with the physical addresses.
    371  1.1      joff 	 */
    372  1.1      joff 	addr = (caddr_t)sc->ctrlpage_dmamap->dm_segs[0].ds_addr;
    373  1.1      joff 	EPE_WRITE(TXDQBAdd, (u_int32_t)addr);
    374  1.1      joff 	EPE_WRITE(TXDQCurAdd, (u_int32_t)addr);
    375  1.1      joff 	EPE_WRITE(TXDQBLen, TX_QLEN * 2 * sizeof(u_int32_t));
    376  1.1      joff 
    377  1.1      joff 	addr += (sc->TXStsQ - sc->TXDQ) * sizeof(u_int32_t);
    378  1.1      joff 	EPE_WRITE(TXStsQBAdd, (u_int32_t)addr);
    379  1.1      joff 	EPE_WRITE(TXStsQCurAdd, (u_int32_t)addr);
    380  1.1      joff 	EPE_WRITE(TXStsQBLen, TX_QLEN * sizeof(u_int32_t));
    381  1.1      joff 
    382  1.1      joff 	addr += (sc->RXDQ - sc->TXStsQ) * sizeof(u_int32_t);
    383  1.1      joff 	EPE_WRITE(RXDQBAdd, (u_int32_t)addr);
    384  1.1      joff 	EPE_WRITE(RXDCurAdd, (u_int32_t)addr);
    385  1.1      joff 	EPE_WRITE(RXDQBLen, RX_QLEN * 2 * sizeof(u_int32_t));
    386  1.1      joff 
    387  1.1      joff 	addr += (sc->RXStsQ - sc->RXDQ) * sizeof(u_int32_t);
    388  1.1      joff 	EPE_WRITE(RXStsQBAdd, (u_int32_t)addr);
    389  1.1      joff 	EPE_WRITE(RXStsQCurAdd, (u_int32_t)addr);
    390  1.1      joff 	EPE_WRITE(RXStsQBLen, RX_QLEN * 2 * sizeof(u_int32_t));
    391  1.1      joff 
    392  1.1      joff 	/* Populate the RXDQ with mbufs */
    393  1.1      joff 	for(i = 0; i < RX_QLEN; i++) {
    394  1.1      joff 		struct mbuf *m;
    395  1.1      joff 
    396  1.1      joff 		bus_dmamap_create(sc->sc_dmat, MCLBYTES, TX_QLEN/4, MCLBYTES, 0,
    397  1.1      joff 			BUS_DMA_WAITOK, &sc->rxq[i].m_dmamap);
    398  1.1      joff 		MGETHDR(m, M_WAIT, MT_DATA);
    399  1.1      joff 		MCLGET(m, M_WAIT);
    400  1.1      joff 		sc->rxq[i].m = m;
    401  1.1      joff 		bus_dmamap_load(sc->sc_dmat, sc->rxq[i].m_dmamap,
    402  1.1      joff 			m->m_ext.ext_buf, MCLBYTES, NULL,
    403  1.1      joff 			BUS_DMA_WAITOK);
    404  1.1      joff 
    405  1.1      joff 		sc->RXDQ[i * 2] = sc->rxq[i].m_dmamap->dm_segs[0].ds_addr;
    406  1.1      joff 		sc->RXDQ[i * 2 + 1] = (i << 16) | MCLBYTES;
    407  1.1      joff 		bus_dmamap_sync(sc->sc_dmat, sc->rxq[i].m_dmamap, 0,
    408  1.1      joff 			MCLBYTES, BUS_DMASYNC_PREREAD);
    409  1.1      joff 	}
    410  1.1      joff 
    411  1.1      joff 	for(i = 0; i < TX_QLEN; i++) {
    412  1.1      joff 		bus_dmamap_create(sc->sc_dmat, MCLBYTES, 1, MCLBYTES, 0,
    413  1.1      joff 			(BUS_DMA_WAITOK|BUS_DMA_ALLOCNOW),
    414  1.1      joff 			&sc->txq[i].m_dmamap);
    415  1.1      joff 		sc->txq[i].m = NULL;
    416  1.1      joff 		sc->TXDQ[i * 2 + 1] = (i << 16);
    417  1.1      joff 	}
    418  1.1      joff 
    419  1.1      joff 	/* Divide HCLK by 32 for MDC clock */
    420  1.7   thorpej 	if (device_cfdata(&sc->sc_dev)->cf_flags)
    421  1.7   thorpej 		mdcdiv = device_cfdata(&sc->sc_dev)->cf_flags;
    422  1.4  hamajima 	EPE_WRITE(SelfCtl, (SelfCtl_MDCDIV(mdcdiv)|SelfCtl_PSPRS));
    423  1.1      joff 
    424  1.1      joff 	sc->sc_mii.mii_ifp = ifp;
    425  1.1      joff 	sc->sc_mii.mii_readreg = epe_mii_readreg;
    426  1.1      joff 	sc->sc_mii.mii_writereg = epe_mii_writereg;
    427  1.1      joff 	sc->sc_mii.mii_statchg = epe_statchg;
    428  1.1      joff 	ifmedia_init(&sc->sc_mii.mii_media, IFM_IMASK, epe_mediachange,
    429  1.1      joff 		epe_mediastatus);
    430  1.1      joff 	mii_attach((struct device *)sc, &sc->sc_mii, 0xffffffff, MII_PHY_ANY,
    431  1.1      joff 		MII_OFFSET_ANY, 0);
    432  1.1      joff 	ifmedia_set(&sc->sc_mii.mii_media, IFM_ETHER|IFM_AUTO);
    433  1.1      joff 
    434  1.1      joff 	EPE_WRITE(BMCtl, BMCtl_RxEn|BMCtl_TxEn);
    435  1.2      joff 	EPE_WRITE(IntEn, IntEn_REOFIE);
    436  1.1      joff 	/* maximum valid max frame length */
    437  1.1      joff 	EPE_WRITE(MaxFrmLen, (0x7ff << 16)|MHLEN);
    438  1.1      joff 	/* wait for receiver ready */
    439  1.1      joff 	while((EPE_READ(BMSts) & BMSts_RxAct) == 0);
    440  1.1      joff 	/* enqueue the entries in RXStsQ and RXDQ */
    441  1.2      joff 	CTRLPAGE_DMASYNC(0, sc->ctrlpage_dmamap->dm_mapsize,
    442  1.1      joff 		BUS_DMASYNC_PREWRITE|BUS_DMASYNC_PREREAD);
    443  1.1      joff 	EPE_WRITE(RXDEnq, RX_QLEN - 1);
    444  1.1      joff 	EPE_WRITE(RXStsEnq, RX_QLEN - 1);
    445  1.1      joff 
    446  1.1      joff 	/*
    447  1.1      joff 	 * We can support 802.1Q VLAN-sized frames.
    448  1.1      joff 	 */
    449  1.1      joff 	sc->sc_ec.ec_capabilities |= ETHERCAP_VLAN_MTU;
    450  1.1      joff 
    451  1.1      joff         strcpy(ifp->if_xname, sc->sc_dev.dv_xname);
    452  1.1      joff         ifp->if_flags = IFF_BROADCAST|IFF_SIMPLEX|IFF_NOTRAILERS|IFF_MULTICAST;
    453  1.1      joff         ifp->if_ioctl = epe_ifioctl;
    454  1.1      joff         ifp->if_start = epe_ifstart;
    455  1.1      joff         ifp->if_watchdog = epe_ifwatchdog;
    456  1.1      joff         ifp->if_init = epe_ifinit;
    457  1.1      joff         ifp->if_stop = epe_ifstop;
    458  1.1      joff         ifp->if_timer = 0;
    459  1.1      joff 	ifp->if_softc = sc;
    460  1.1      joff         IFQ_SET_READY(&ifp->if_snd);
    461  1.1      joff         if_attach(ifp);
    462  1.1      joff         ether_ifattach(ifp, (sc)->sc_enaddr);
    463  1.1      joff }
    464  1.1      joff 
    465  1.1      joff static int
    466  1.1      joff epe_mediachange(ifp)
    467  1.1      joff 	struct ifnet *ifp;
    468  1.1      joff {
    469  1.1      joff 	if (ifp->if_flags & IFF_UP)
    470  1.1      joff 		epe_ifinit(ifp);
    471  1.1      joff 	return (0);
    472  1.1      joff }
    473  1.1      joff 
    474  1.1      joff static void
    475  1.1      joff epe_mediastatus(ifp, ifmr)
    476  1.1      joff 	struct ifnet *ifp;
    477  1.1      joff 	struct ifmediareq *ifmr;
    478  1.1      joff {
    479  1.1      joff 	struct epe_softc *sc = ifp->if_softc;
    480  1.1      joff 
    481  1.1      joff 	mii_pollstat(&sc->sc_mii);
    482  1.1      joff 	ifmr->ifm_active = sc->sc_mii.mii_media_active;
    483  1.1      joff 	ifmr->ifm_status = sc->sc_mii.mii_media_status;
    484  1.1      joff }
    485  1.1      joff 
    486  1.1      joff 
    487  1.1      joff int
    488  1.1      joff epe_mii_readreg(self, phy, reg)
    489  1.1      joff 	struct device *self;
    490  1.1      joff 	int phy, reg;
    491  1.1      joff {
    492  1.1      joff 	u_int32_t d, v;
    493  1.2      joff 	struct epe_softc *sc;
    494  1.1      joff 
    495  1.2      joff 	sc = (struct epe_softc *)self;
    496  1.1      joff 	d = EPE_READ(SelfCtl);
    497  1.1      joff 	EPE_WRITE(SelfCtl, d & ~SelfCtl_PSPRS); /* no preamble suppress */
    498  1.1      joff 	EPE_WRITE(MIICmd, (MIICmd_READ | (phy << 5) | reg));
    499  1.1      joff 	while(EPE_READ(MIISts) & MIISts_BUSY);
    500  1.1      joff 	v = EPE_READ(MIIData);
    501  1.1      joff 	EPE_WRITE(SelfCtl, d); /* restore old value */
    502  1.1      joff 	return v;
    503  1.1      joff }
    504  1.1      joff 
    505  1.1      joff void
    506  1.1      joff epe_mii_writereg(self, phy, reg, val)
    507  1.1      joff 	struct device *self;
    508  1.1      joff 	int phy, reg, val;
    509  1.1      joff {
    510  1.2      joff 	struct epe_softc *sc;
    511  1.1      joff 	u_int32_t d;
    512  1.1      joff 
    513  1.2      joff 	sc = (struct epe_softc *)self;
    514  1.1      joff 	d = EPE_READ(SelfCtl);
    515  1.1      joff 	EPE_WRITE(SelfCtl, d & ~SelfCtl_PSPRS); /* no preamble suppress */
    516  1.3  hamajima 	EPE_WRITE(MIIData, val);
    517  1.1      joff 	EPE_WRITE(MIICmd, (MIICmd_WRITE | (phy << 5) | reg));
    518  1.1      joff 	while(EPE_READ(MIISts) & MIISts_BUSY);
    519  1.1      joff 	EPE_WRITE(SelfCtl, d); /* restore old value */
    520  1.1      joff }
    521  1.1      joff 
    522  1.1      joff 
    523  1.1      joff void
    524  1.1      joff epe_statchg(self)
    525  1.1      joff         struct device *self;
    526  1.1      joff {
    527  1.1      joff         struct epe_softc *sc = (struct epe_softc *)self;
    528  1.1      joff         u_int32_t reg;
    529  1.1      joff 
    530  1.1      joff         /*
    531  1.1      joff          * We must keep the MAC and the PHY in sync as
    532  1.1      joff          * to the status of full-duplex!
    533  1.1      joff          */
    534  1.1      joff         reg = EPE_READ(TestCtl);
    535  1.1      joff         if (sc->sc_mii.mii_media_active & IFM_FDX)
    536  1.1      joff                 reg |= TestCtl_MFDX;
    537  1.1      joff         else
    538  1.1      joff                 reg &= ~TestCtl_MFDX;
    539  1.1      joff 	EPE_WRITE(TestCtl, reg);
    540  1.1      joff }
    541  1.1      joff 
    542  1.1      joff void
    543  1.1      joff epe_tick(arg)
    544  1.1      joff 	void *arg;
    545  1.1      joff {
    546  1.1      joff 	struct epe_softc* sc = (struct epe_softc *)arg;
    547  1.1      joff 	struct ifnet * ifp = &sc->sc_ec.ec_if;
    548  1.2      joff 	int s;
    549  1.1      joff 	u_int32_t misses;
    550  1.1      joff 
    551  1.1      joff 	ifp->if_collisions += EPE_READ(TXCollCnt);
    552  1.1      joff 	/* These misses are ok, they will happen if the RAM/CPU can't keep up */
    553  1.1      joff 	misses = EPE_READ(RXMissCnt);
    554  1.1      joff 	if (misses > 0)
    555  1.1      joff 		printf("%s: %d rx misses\n", sc->sc_dev.dv_xname, misses);
    556  1.1      joff 
    557  1.2      joff 	s = splnet();
    558  1.2      joff 	if (epe_gctx(sc) > 0 && IFQ_IS_EMPTY(&ifp->if_snd) == 0) {
    559  1.2      joff 		epe_ifstart(ifp);
    560  1.2      joff 	}
    561  1.2      joff 	splx(s);
    562  1.2      joff 
    563  1.1      joff 	mii_tick(&sc->sc_mii);
    564  1.1      joff 	callout_reset(&sc->epe_tick_ch, hz, epe_tick, sc);
    565  1.1      joff }
    566  1.1      joff 
    567  1.1      joff 
    568  1.1      joff static int
    569  1.1      joff epe_ifioctl(ifp, cmd, data)
    570  1.1      joff 	struct ifnet *ifp;
    571  1.1      joff 	u_long cmd;
    572  1.1      joff 	caddr_t data;
    573  1.1      joff {
    574  1.1      joff 	struct epe_softc *sc = ifp->if_softc;
    575  1.1      joff 	struct ifreq *ifr = (struct ifreq *)data;
    576  1.1      joff 	int s, error;
    577  1.1      joff 
    578  1.1      joff 	s = splnet();
    579  1.1      joff 	switch(cmd) {
    580  1.1      joff 	case SIOCSIFMEDIA:
    581  1.1      joff 	case SIOCGIFMEDIA:
    582  1.1      joff 		error = ifmedia_ioctl(ifp, ifr, &sc->sc_mii.mii_media, cmd);
    583  1.1      joff 		break;
    584  1.1      joff 	default:
    585  1.1      joff 		error = ether_ioctl(ifp, cmd, data);
    586  1.1      joff 		if (error == ENETRESET) {
    587  1.1      joff 			if (ifp->if_flags & IFF_RUNNING)
    588  1.1      joff 				epe_setaddr(ifp);
    589  1.1      joff 			error = 0;
    590  1.1      joff 		}
    591  1.1      joff 	}
    592  1.1      joff 	splx(s);
    593  1.1      joff 	return error;
    594  1.1      joff }
    595  1.1      joff 
    596  1.1      joff static void
    597  1.1      joff epe_ifstart(ifp)
    598  1.1      joff 	struct ifnet *ifp;
    599  1.1      joff {
    600  1.1      joff 	struct epe_softc *sc = (struct epe_softc *)ifp->if_softc;
    601  1.1      joff 	struct mbuf *m;
    602  1.1      joff 	bus_dma_segment_t *segs;
    603  1.2      joff 	int s, bi, err, nsegs, ndq;
    604  1.2      joff 
    605  1.2      joff 	s = splnet();
    606  1.2      joff start:
    607  1.2      joff 	ndq = 0;
    608  1.1      joff 	if (sc->TXDQ_avail == 0) {
    609  1.2      joff 		if (epe_gctx(sc) == 0) {
    610  1.2      joff 			/* Enable End-Of-TX-Chain interrupt */
    611  1.2      joff 			EPE_WRITE(IntEn, IntEn_REOFIE|IntEn_ECIE);
    612  1.2      joff 			ifp->if_flags |= IFF_OACTIVE;
    613  1.2      joff 			ifp->if_timer = 10;
    614  1.2      joff 			splx(s);
    615  1.2      joff 			return;
    616  1.2      joff 		}
    617  1.2      joff 	}
    618  1.2      joff 
    619  1.1      joff 	bi = sc->TXDQ_cur - sc->TXDQ;
    620  1.1      joff 
    621  1.1      joff 	IFQ_POLL(&ifp->if_snd, m);
    622  1.1      joff 	if (m == NULL) {
    623  1.1      joff 		splx(s);
    624  1.1      joff 		return;
    625  1.1      joff 	}
    626  1.2      joff more:
    627  1.1      joff 	if ((err = bus_dmamap_load_mbuf(sc->sc_dmat, sc->txq[bi].m_dmamap, m,
    628  1.1      joff 		BUS_DMA_NOWAIT)) ||
    629  1.1      joff 		sc->txq[bi].m_dmamap->dm_segs[0].ds_addr & 0x3 ||
    630  1.1      joff 		sc->txq[bi].m_dmamap->dm_nsegs > (sc->TXDQ_avail - ndq)) {
    631  1.1      joff 		/* Copy entire mbuf chain to new and 32-bit aligned storage */
    632  1.1      joff 		struct mbuf *mn;
    633  1.1      joff 
    634  1.1      joff 		if (err == 0)
    635  1.1      joff 			bus_dmamap_unload(sc->sc_dmat, sc->txq[bi].m_dmamap);
    636  1.1      joff 
    637  1.1      joff 		MGETHDR(mn, M_DONTWAIT, MT_DATA);
    638  1.1      joff 		if (mn == NULL) goto stop;
    639  1.1      joff 		if (m->m_pkthdr.len > (MHLEN & (~0x3))) {
    640  1.1      joff 			MCLGET(mn, M_DONTWAIT);
    641  1.1      joff 			if ((mn->m_flags & M_EXT) == 0) {
    642  1.1      joff 				m_freem(mn);
    643  1.1      joff 				goto stop;
    644  1.1      joff 			}
    645  1.1      joff 		}
    646  1.1      joff 		mn->m_data = (caddr_t)(((u_int32_t)mn->m_data + 0x3) & (~0x3));
    647  1.1      joff 		m_copydata(m, 0, m->m_pkthdr.len, mtod(mn, caddr_t));
    648  1.1      joff 		mn->m_pkthdr.len = mn->m_len = m->m_pkthdr.len;
    649  1.1      joff 		IFQ_DEQUEUE(&ifp->if_snd, m);
    650  1.1      joff 		m_freem(m);
    651  1.1      joff 		m = mn;
    652  1.1      joff 		bus_dmamap_load_mbuf(sc->sc_dmat, sc->txq[bi].m_dmamap, m,
    653  1.1      joff 			BUS_DMA_NOWAIT);
    654  1.1      joff 	} else {
    655  1.1      joff 		IFQ_DEQUEUE(&ifp->if_snd, m);
    656  1.1      joff 	}
    657  1.1      joff 
    658  1.1      joff #if NBPFILTER > 0
    659  1.1      joff 	if (ifp->if_bpf)
    660  1.1      joff 		bpf_mtap(ifp->if_bpf, m);
    661  1.1      joff #endif /* NBPFILTER > 0 */
    662  1.1      joff 
    663  1.1      joff 	nsegs = sc->txq[bi].m_dmamap->dm_nsegs;
    664  1.1      joff 	segs = sc->txq[bi].m_dmamap->dm_segs;
    665  1.1      joff 	bus_dmamap_sync(sc->sc_dmat, sc->txq[bi].m_dmamap, 0,
    666  1.1      joff 		sc->txq[bi].m_dmamap->dm_mapsize,
    667  1.1      joff 		BUS_DMASYNC_PREREAD|BUS_DMASYNC_PREWRITE);
    668  1.1      joff 
    669  1.1      joff 	/* XXX: This driver hasn't been tested w/nsegs > 1 */
    670  1.1      joff 	while (nsegs > 0) {
    671  1.1      joff 		nsegs--;
    672  1.1      joff 		sc->txq[bi].m = m;
    673  1.1      joff 		sc->TXDQ[bi * 2] = segs->ds_addr;
    674  1.1      joff 		if (nsegs == 0)
    675  1.1      joff 			sc->TXDQ[bi * 2 + 1] = segs->ds_len | (bi << 16) |
    676  1.1      joff 				(1 << 31);
    677  1.1      joff 		else
    678  1.1      joff 			sc->TXDQ[bi * 2 + 1] = segs->ds_len | (bi << 16);
    679  1.1      joff 		segs++;
    680  1.1      joff 		bi = (bi + 1) % TX_QLEN;
    681  1.1      joff 		ndq++;
    682  1.1      joff 	}
    683  1.1      joff 
    684  1.1      joff 
    685  1.2      joff 	/*
    686  1.2      joff 	 * Enqueue another.  Don't do more than half the available
    687  1.2      joff 	 * descriptors before telling the MAC about them
    688  1.2      joff 	 */
    689  1.2      joff 	if ((sc->TXDQ_avail - ndq) > 0 && ndq < TX_QLEN / 2) {
    690  1.1      joff 		IFQ_POLL(&ifp->if_snd, m);
    691  1.1      joff 		if (m != NULL) {
    692  1.2      joff 			goto more;
    693  1.1      joff 		}
    694  1.1      joff 	}
    695  1.1      joff stop:
    696  1.1      joff 	if (ndq > 0) {
    697  1.1      joff 		sc->TXDQ_avail -= ndq;
    698  1.1      joff 		sc->TXDQ_cur = &sc->TXDQ[bi];
    699  1.2      joff 		CTRLPAGE_DMASYNC(0, TX_QLEN * 2 * sizeof(u_int32_t),
    700  1.1      joff 			BUS_DMASYNC_PREWRITE|BUS_DMASYNC_PREREAD);
    701  1.1      joff 		EPE_WRITE(TXDEnq, ndq);
    702  1.1      joff 	}
    703  1.2      joff 
    704  1.2      joff 	if (IFQ_IS_EMPTY(&ifp->if_snd) == 0)
    705  1.2      joff 		goto start;
    706  1.2      joff 
    707  1.1      joff 	splx(s);
    708  1.1      joff 	return;
    709  1.1      joff }
    710  1.1      joff 
    711  1.1      joff static void
    712  1.1      joff epe_ifwatchdog(ifp)
    713  1.1      joff 	struct ifnet *ifp;
    714  1.1      joff {
    715  1.1      joff 	struct epe_softc *sc = (struct epe_softc *)ifp->if_softc;
    716  1.1      joff 
    717  1.1      joff 	if ((ifp->if_flags & IFF_RUNNING) == 0)
    718  1.1      joff 		return;
    719  1.2      joff        	printf("%s: device timeout, BMCtl = 0x%08x, BMSts = 0x%08x\n",
    720  1.1      joff 		sc->sc_dev.dv_xname, EPE_READ(BMCtl), EPE_READ(BMSts));
    721  1.1      joff }
    722  1.1      joff 
    723  1.1      joff static int
    724  1.1      joff epe_ifinit(ifp)
    725  1.1      joff 	struct ifnet *ifp;
    726  1.1      joff {
    727  1.1      joff 	struct epe_softc *sc = ifp->if_softc;
    728  1.1      joff 	int s = splnet();
    729  1.1      joff 
    730  1.1      joff 	callout_stop(&sc->epe_tick_ch);
    731  1.1      joff 	EPE_WRITE(RXCtl, RXCtl_IA0|RXCtl_BA|RXCtl_RCRCA|RXCtl_SRxON);
    732  1.1      joff 	EPE_WRITE(TXCtl, TXCtl_STxON);
    733  1.1      joff 	EPE_WRITE(GIIntMsk, GIIntMsk_INT); /* start interrupting */
    734  1.1      joff 	mii_mediachg(&sc->sc_mii);
    735  1.1      joff 	callout_reset(&sc->epe_tick_ch, hz, epe_tick, sc);
    736  1.1      joff         ifp->if_flags |= IFF_RUNNING;
    737  1.1      joff 	splx(s);
    738  1.1      joff 	return 0;
    739  1.1      joff }
    740  1.1      joff 
    741  1.1      joff static void
    742  1.1      joff epe_ifstop(ifp, disable)
    743  1.1      joff 	struct ifnet *ifp;
    744  1.1      joff 	int disable;
    745  1.1      joff {
    746  1.1      joff 	struct epe_softc *sc = ifp->if_softc;
    747  1.1      joff 
    748  1.1      joff 
    749  1.1      joff 	EPE_WRITE(RXCtl, 0);
    750  1.1      joff 	EPE_WRITE(TXCtl, 0);
    751  1.1      joff 	EPE_WRITE(GIIntMsk, 0);
    752  1.1      joff 	callout_stop(&sc->epe_tick_ch);
    753  1.1      joff 
    754  1.1      joff 	/* Down the MII. */
    755  1.1      joff 	mii_down(&sc->sc_mii);
    756  1.1      joff 
    757  1.1      joff 	ifp->if_flags &= ~(IFF_RUNNING | IFF_OACTIVE);
    758  1.1      joff 	ifp->if_timer = 0;
    759  1.1      joff 	sc->sc_mii.mii_media_status &= ~IFM_ACTIVE;
    760  1.1      joff }
    761  1.1      joff 
    762  1.1      joff static void
    763  1.1      joff epe_setaddr(ifp)
    764  1.1      joff 	struct ifnet *ifp;
    765  1.1      joff {
    766  1.1      joff 	struct epe_softc *sc = ifp->if_softc;
    767  1.1      joff 	struct ethercom *ac = &sc->sc_ec;
    768  1.1      joff 	struct ether_multi *enm;
    769  1.1      joff 	struct ether_multistep step;
    770  1.1      joff 	u_int8_t ias[2][ETHER_ADDR_LEN];
    771  1.1      joff 	u_int32_t h, nma = 0, hashes[2] = { 0, 0 };
    772  1.1      joff 	u_int32_t rxctl = EPE_READ(RXCtl);
    773  1.1      joff 
    774  1.1      joff 	/* disable receiver temporarily */
    775  1.1      joff 	EPE_WRITE(RXCtl, rxctl & ~RXCtl_SRxON);
    776  1.1      joff 
    777  1.1      joff 	rxctl &= ~(RXCtl_MA|RXCtl_PA|RXCtl_IA2|RXCtl_IA3);
    778  1.1      joff 
    779  1.1      joff 	if (ifp->if_flags & IFF_PROMISC) {
    780  1.1      joff 		rxctl |= RXCtl_PA;
    781  1.1      joff 	}
    782  1.1      joff 
    783  1.1      joff 	ifp->if_flags &= ~IFF_ALLMULTI;
    784  1.1      joff 
    785  1.1      joff 	ETHER_FIRST_MULTI(step, ac, enm);
    786  1.1      joff 	while (enm != NULL) {
    787  1.1      joff 		if (memcmp(enm->enm_addrlo, enm->enm_addrhi, ETHER_ADDR_LEN)) {
    788  1.1      joff 			/*
    789  1.1      joff 			 * We must listen to a range of multicast addresses.
    790  1.1      joff 			 * For now, just accept all multicasts, rather than
    791  1.1      joff 			 * trying to set only those filter bits needed to match
    792  1.1      joff 			 * the range.  (At this time, the only use of address
    793  1.1      joff 			 * ranges is for IP multicast routing, for which the
    794  1.1      joff 			 * range is big enough to require all bits set.)
    795  1.1      joff 			 */
    796  1.1      joff 			rxctl &= ~(RXCtl_IA2|RXCtl_IA3);
    797  1.1      joff 			rxctl |= RXCtl_MA;
    798  1.1      joff 			hashes[0] = 0xffffffffUL;
    799  1.1      joff 			hashes[1] = 0xffffffffUL;
    800  1.1      joff 			ifp->if_flags |= IFF_ALLMULTI;
    801  1.1      joff 			break;
    802  1.1      joff 		}
    803  1.1      joff 
    804  1.1      joff 		if (nma < 2) {
    805  1.1      joff 			/* We can program 2 perfect address filters for mcast */
    806  1.1      joff 			memcpy(ias[nma], enm->enm_addrlo, ETHER_ADDR_LEN);
    807  1.1      joff 			rxctl |= (1 << (nma + 2));
    808  1.1      joff 		} else {
    809  1.1      joff 			/*
    810  1.1      joff 			 * XXX: Datasheet is not very clear here, I'm not sure
    811  1.1      joff 			 * if I'm doing this right.  --joff
    812  1.1      joff 			 */
    813  1.1      joff 			h = ether_crc32_le(enm->enm_addrlo, ETHER_ADDR_LEN);
    814  1.1      joff 
    815  1.1      joff 			/* Just want the 6 most-significant bits. */
    816  1.1      joff 			h = h >> 26;
    817  1.1      joff 
    818  1.1      joff 			hashes[ h / 32 ] |=  (1 << (h % 32));
    819  1.1      joff 			rxctl |= RXCtl_MA;
    820  1.1      joff 		}
    821  1.1      joff 		ETHER_NEXT_MULTI(step, enm);
    822  1.1      joff 		nma++;
    823  1.1      joff 	}
    824  1.1      joff 
    825  1.1      joff 	EPE_WRITE(AFP, 0);
    826  1.1      joff 	bus_space_write_region_1(sc->sc_iot, sc->sc_ioh, EPE_IndAd,
    827  1.1      joff 		sc->sc_enaddr, ETHER_ADDR_LEN);
    828  1.1      joff 	if (rxctl & RXCtl_IA2) {
    829  1.1      joff 		EPE_WRITE(AFP, 2);
    830  1.1      joff 		bus_space_write_region_1(sc->sc_iot, sc->sc_ioh, EPE_IndAd,
    831  1.1      joff 			ias[0], ETHER_ADDR_LEN);
    832  1.1      joff 	}
    833  1.1      joff 	if (rxctl & RXCtl_IA3) {
    834  1.1      joff 		EPE_WRITE(AFP, 3);
    835  1.1      joff 		bus_space_write_region_1(sc->sc_iot, sc->sc_ioh, EPE_IndAd,
    836  1.1      joff 			ias[1], ETHER_ADDR_LEN);
    837  1.1      joff 	}
    838  1.1      joff 	if (hashes[0] != 0 && hashes[1] != 0) {
    839  1.1      joff 		EPE_WRITE(AFP, 7);
    840  1.1      joff 		EPE_WRITE(HashTbl, hashes[0]);
    841  1.1      joff 		EPE_WRITE(HashTbl + 4, hashes[1]);
    842  1.1      joff 	}
    843  1.1      joff 	EPE_WRITE(RXCtl, rxctl);
    844  1.1      joff }
    845