Home | History | Annotate | Line # | Download | only in qbus
if_qe.c revision 1.45
      1 /*      $NetBSD: if_qe.c,v 1.45 2000/12/14 07:15:45 thorpej Exp $ */
      2 /*
      3  * Copyright (c) 1999 Ludd, University of Lule}, Sweden. All rights reserved.
      4  *
      5  * Redistribution and use in source and binary forms, with or without
      6  * modification, are permitted provided that the following conditions
      7  * are met:
      8  * 1. Redistributions of source code must retain the above copyright
      9  *    notice, this list of conditions and the following disclaimer.
     10  * 2. Redistributions in binary form must reproduce the above copyright
     11  *    notice, this list of conditions and the following disclaimer in the
     12  *    documentation and/or other materials provided with the distribution.
     13  * 3. All advertising materials mentioning features or use of this software
     14  *    must display the following acknowledgement:
     15  *      This product includes software developed at Ludd, University of
     16  *      Lule}, Sweden and its contributors.
     17  * 4. The name of the author may not be used to endorse or promote products
     18  *    derived from this software without specific prior written permission
     19  *
     20  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
     21  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
     22  * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
     23  * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
     24  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
     25  * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
     26  * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
     27  * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
     28  * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
     29  * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
     30  */
     31 
     32 /*
     33  * Driver for DEQNA/DELQA ethernet cards.
     34  * Things that is still to do:
     35  *	Have a timeout check for hang transmit logic.
     36  *	Handle ubaresets. Does not work at all right now.
     37  *	Fix ALLMULTI reception. But someone must tell me how...
     38  *	Collect statistics.
     39  */
     40 
     41 #include "opt_inet.h"
     42 #include "bpfilter.h"
     43 
     44 #include <sys/param.h>
     45 #include <sys/mbuf.h>
     46 #include <sys/socket.h>
     47 #include <sys/device.h>
     48 #include <sys/systm.h>
     49 #include <sys/sockio.h>
     50 
     51 #include <net/if.h>
     52 #include <net/if_ether.h>
     53 #include <net/if_dl.h>
     54 
     55 #include <netinet/in.h>
     56 #include <netinet/if_inarp.h>
     57 
     58 #if NBPFILTER > 0
     59 #include <net/bpf.h>
     60 #include <net/bpfdesc.h>
     61 #endif
     62 
     63 #include <machine/bus.h>
     64 
     65 #include <dev/qbus/ubavar.h>
     66 #include <dev/qbus/if_qereg.h>
     67 
     68 #include "ioconf.h"
     69 
     70 #define RXDESCS	30	/* # of receive descriptors */
     71 #define TXDESCS	60	/* # transmit descs */
     72 
     73 /*
     74  * Structure containing the elements that must be in DMA-safe memory.
     75  */
     76 struct qe_cdata {
     77 	struct qe_ring	qc_recv[RXDESCS+1];	/* Receive descriptors */
     78 	struct qe_ring	qc_xmit[TXDESCS+1];	/* Transmit descriptors */
     79 	u_int8_t	qc_setup[128];		/* Setup packet layout */
     80 };
     81 
     82 struct	qe_softc {
     83 	struct device	sc_dev;		/* Configuration common part	*/
     84 	struct evcnt	sc_intrcnt;	/* Interrupt counting		*/
     85 	struct ethercom sc_ec;		/* Ethernet common part		*/
     86 #define sc_if	sc_ec.ec_if		/* network-visible interface	*/
     87 	bus_space_tag_t sc_iot;
     88 	bus_addr_t	sc_ioh;
     89 	bus_dma_tag_t	sc_dmat;
     90 	struct qe_cdata *sc_qedata;	/* Descriptor struct		*/
     91 	struct qe_cdata *sc_pqedata;	/* Unibus address of above	*/
     92 	bus_dmamap_t	sc_cmap;	/* Map for control structures	*/
     93 	struct mbuf*	sc_txmbuf[TXDESCS];
     94 	struct mbuf*	sc_rxmbuf[RXDESCS];
     95 	bus_dmamap_t	sc_xmtmap[TXDESCS];
     96 	bus_dmamap_t	sc_rcvmap[RXDESCS];
     97 	int		sc_intvec;	/* Interrupt vector		*/
     98 	int		sc_nexttx;
     99 	int		sc_inq;
    100 	int		sc_lastack;
    101 	int		sc_nextrx;
    102 	int		sc_setup;	/* Setup packet in queue	*/
    103 };
    104 
    105 static	int	qematch __P((struct device *, struct cfdata *, void *));
    106 static	void	qeattach __P((struct device *, struct device *, void *));
    107 static	void	qeinit __P((struct qe_softc *));
    108 static	void	qestart __P((struct ifnet *));
    109 static	void	qeintr __P((void *));
    110 static	int	qeioctl __P((struct ifnet *, u_long, caddr_t));
    111 static	int	qe_add_rxbuf __P((struct qe_softc *, int));
    112 static	void	qe_setup __P((struct qe_softc *));
    113 static	void	qetimeout __P((struct ifnet *));
    114 
    115 struct	cfattach qe_ca = {
    116 	sizeof(struct qe_softc), qematch, qeattach
    117 };
    118 
    119 #define	QE_WCSR(csr, val) \
    120 	bus_space_write_2(sc->sc_iot, sc->sc_ioh, csr, val)
    121 #define	QE_RCSR(csr) \
    122 	bus_space_read_2(sc->sc_iot, sc->sc_ioh, csr)
    123 
    124 #define	LOWORD(x)	((int)(x) & 0xffff)
    125 #define	HIWORD(x)	(((int)(x) >> 16) & 0x3f)
    126 
    127 /*
    128  * Check for present DEQNA. Done by sending a fake setup packet
    129  * and wait for interrupt.
    130  */
    131 int
    132 qematch(parent, cf, aux)
    133 	struct	device *parent;
    134 	struct	cfdata *cf;
    135 	void	*aux;
    136 {
    137 	bus_dmamap_t	cmap;
    138 	struct	qe_softc ssc;
    139 	struct	qe_softc *sc = &ssc;
    140 	struct	uba_attach_args *ua = aux;
    141 	struct	uba_softc *ubasc = (struct uba_softc *)parent;
    142 
    143 #define	PROBESIZE	(sizeof(struct qe_ring) * 4 + 128)
    144 	struct	qe_ring ring[15]; /* For diag purposes only */
    145 	struct	qe_ring *rp;
    146 	int error;
    147 
    148 	bzero(sc, sizeof(struct qe_softc));
    149 	bzero(ring, PROBESIZE);
    150 	sc->sc_iot = ua->ua_iot;
    151 	sc->sc_ioh = ua->ua_ioh;
    152 	sc->sc_dmat = ua->ua_dmat;
    153 
    154 	ubasc->uh_lastiv -= 4;
    155 	QE_WCSR(QE_CSR_CSR, QE_RESET);
    156 	QE_WCSR(QE_CSR_VECTOR, ubasc->uh_lastiv);
    157 
    158 	/*
    159 	 * Map the ring area. Actually this is done only to be able to
    160 	 * send and receive a internal packet; some junk is loopbacked
    161 	 * so that the DEQNA has a reason to interrupt.
    162 	 */
    163 	if ((error = bus_dmamap_create(sc->sc_dmat, PROBESIZE, 1, PROBESIZE, 0,
    164 	    BUS_DMA_NOWAIT, &cmap))) {
    165 		printf("qematch: bus_dmamap_create failed = %d\n", error);
    166 		return 0;
    167 	}
    168 	if ((error = bus_dmamap_load(sc->sc_dmat, cmap, ring, PROBESIZE, 0,
    169 	    BUS_DMA_NOWAIT))) {
    170 		printf("qematch: bus_dmamap_load failed = %d\n", error);
    171 		bus_dmamap_destroy(sc->sc_dmat, cmap);
    172 		return 0;
    173 	}
    174 
    175 	/*
    176 	 * Init a simple "fake" receive and transmit descriptor that
    177 	 * points to some unused area. Send a fake setup packet.
    178 	 */
    179 	rp = (void *)cmap->dm_segs[0].ds_addr;
    180 	ring[0].qe_flag = ring[0].qe_status1 = QE_NOTYET;
    181 	ring[0].qe_addr_lo = LOWORD(&rp[4]);
    182 	ring[0].qe_addr_hi = HIWORD(&rp[4]) | QE_VALID | QE_EOMSG | QE_SETUP;
    183 	ring[0].qe_buf_len = 128;
    184 
    185 	ring[2].qe_flag = ring[2].qe_status1 = QE_NOTYET;
    186 	ring[2].qe_addr_lo = LOWORD(&rp[4]);
    187 	ring[2].qe_addr_hi = HIWORD(&rp[4]) | QE_VALID;
    188 	ring[2].qe_buf_len = 128;
    189 
    190 	QE_WCSR(QE_CSR_CSR, QE_RCSR(QE_CSR_CSR) & ~QE_RESET);
    191 	DELAY(1000);
    192 
    193 	/*
    194 	 * Start the interface and wait for the packet.
    195 	 */
    196 	QE_WCSR(QE_CSR_CSR, QE_INT_ENABLE|QE_XMIT_INT|QE_RCV_INT);
    197 	QE_WCSR(QE_CSR_RCLL, LOWORD(&rp[2]));
    198 	QE_WCSR(QE_CSR_RCLH, HIWORD(&rp[2]));
    199 	QE_WCSR(QE_CSR_XMTL, LOWORD(rp));
    200 	QE_WCSR(QE_CSR_XMTH, HIWORD(rp));
    201 	DELAY(10000);
    202 
    203 	/*
    204 	 * All done with the bus resources.
    205 	 */
    206 	bus_dmamap_unload(sc->sc_dmat, cmap);
    207 	bus_dmamap_destroy(sc->sc_dmat, cmap);
    208 	return 1;
    209 }
    210 
    211 /*
    212  * Interface exists: make available by filling in network interface
    213  * record.  System will initialize the interface when it is ready
    214  * to accept packets.
    215  */
    216 void
    217 qeattach(parent, self, aux)
    218 	struct	device *parent, *self;
    219 	void	*aux;
    220 {
    221 	struct	uba_attach_args *ua = aux;
    222 	struct	uba_softc *ubasc = (struct uba_softc *)parent;
    223 	struct	qe_softc *sc = (struct qe_softc *)self;
    224 	struct	ifnet *ifp = (struct ifnet *)&sc->sc_if;
    225 	struct	qe_ring *rp;
    226 	u_int8_t enaddr[ETHER_ADDR_LEN];
    227 	bus_dma_segment_t seg;
    228 	int i, rseg, error;
    229 
    230 	sc->sc_iot = ua->ua_iot;
    231 	sc->sc_ioh = ua->ua_ioh;
    232 	sc->sc_dmat = ua->ua_dmat;
    233 
    234         /*
    235          * Allocate DMA safe memory for descriptors and setup memory.
    236          */
    237 	if ((error = bus_dmamem_alloc(sc->sc_dmat,
    238 	    sizeof(struct qe_cdata), NBPG, 0, &seg, 1, &rseg,
    239 	    BUS_DMA_NOWAIT)) != 0) {
    240 		printf(": unable to allocate control data, error = %d\n",
    241 		    error);
    242 		goto fail_0;
    243 	}
    244 
    245 	if ((error = bus_dmamem_map(sc->sc_dmat, &seg, rseg,
    246 	    sizeof(struct qe_cdata), (caddr_t *)&sc->sc_qedata,
    247 	    BUS_DMA_NOWAIT|BUS_DMA_COHERENT)) != 0) {
    248 		printf(": unable to map control data, error = %d\n", error);
    249 		goto fail_1;
    250 	}
    251 
    252 	if ((error = bus_dmamap_create(sc->sc_dmat,
    253 	    sizeof(struct qe_cdata), 1,
    254 	    sizeof(struct qe_cdata), 0, BUS_DMA_NOWAIT,
    255 	    &sc->sc_cmap)) != 0) {
    256 		printf(": unable to create control data DMA map, error = %d\n",
    257 		    error);
    258 		goto fail_2;
    259 	}
    260 
    261 	if ((error = bus_dmamap_load(sc->sc_dmat, sc->sc_cmap,
    262 	    sc->sc_qedata, sizeof(struct qe_cdata), NULL,
    263 	    BUS_DMA_NOWAIT)) != 0) {
    264 		printf(": unable to load control data DMA map, error = %d\n",
    265 		    error);
    266 		goto fail_3;
    267 	}
    268 
    269 	/*
    270 	 * Zero the newly allocated memory.
    271 	 */
    272 	bzero(sc->sc_qedata, sizeof(struct qe_cdata));
    273 	/*
    274 	 * Create the transmit descriptor DMA maps. We take advantage
    275 	 * of the fact that the Qbus address space is big, and therefore
    276 	 * allocate map registers for all transmit descriptors also,
    277 	 * so that we can avoid this each time we send a packet.
    278 	 */
    279 	for (i = 0; i < TXDESCS; i++) {
    280 		if ((error = bus_dmamap_create(sc->sc_dmat, MCLBYTES,
    281 		    1, MCLBYTES, 0, BUS_DMA_NOWAIT|BUS_DMA_ALLOCNOW,
    282 		    &sc->sc_xmtmap[i]))) {
    283 			printf(": unable to create tx DMA map %d, error = %d\n",
    284 			    i, error);
    285 			goto fail_4;
    286 		}
    287 	}
    288 
    289 	/*
    290 	 * Create receive buffer DMA maps.
    291 	 */
    292 	for (i = 0; i < RXDESCS; i++) {
    293 		if ((error = bus_dmamap_create(sc->sc_dmat, MCLBYTES, 1,
    294 		    MCLBYTES, 0, BUS_DMA_NOWAIT,
    295 		    &sc->sc_rcvmap[i]))) {
    296 			printf(": unable to create rx DMA map %d, error = %d\n",
    297 			    i, error);
    298 			goto fail_5;
    299 		}
    300 	}
    301 	/*
    302 	 * Pre-allocate the receive buffers.
    303 	 */
    304 	for (i = 0; i < RXDESCS; i++) {
    305 		if ((error = qe_add_rxbuf(sc, i)) != 0) {
    306 			printf(": unable to allocate or map rx buffer %d\n,"
    307 			    " error = %d\n", i, error);
    308 			goto fail_6;
    309 		}
    310 	}
    311 
    312 	/*
    313 	 * Create ring loops of the buffer chains.
    314 	 * This is only done once.
    315 	 */
    316 	sc->sc_pqedata = (struct qe_cdata *)sc->sc_cmap->dm_segs[0].ds_addr;
    317 
    318 	rp = sc->sc_qedata->qc_recv;
    319 	rp[RXDESCS].qe_addr_lo = LOWORD(&sc->sc_pqedata->qc_recv[0]);
    320 	rp[RXDESCS].qe_addr_hi = HIWORD(&sc->sc_pqedata->qc_recv[0]) |
    321 	    QE_VALID | QE_CHAIN;
    322 	rp[RXDESCS].qe_flag = rp[RXDESCS].qe_status1 = QE_NOTYET;
    323 
    324 	rp = sc->sc_qedata->qc_xmit;
    325 	rp[TXDESCS].qe_addr_lo = LOWORD(&sc->sc_pqedata->qc_xmit[0]);
    326 	rp[TXDESCS].qe_addr_hi = HIWORD(&sc->sc_pqedata->qc_xmit[0]) |
    327 	    QE_VALID | QE_CHAIN;
    328 	rp[TXDESCS].qe_flag = rp[TXDESCS].qe_status1 = QE_NOTYET;
    329 
    330 	/*
    331 	 * Get the vector that were set at match time, and remember it.
    332 	 */
    333 	sc->sc_intvec = ubasc->uh_lastiv;
    334 	QE_WCSR(QE_CSR_CSR, QE_RESET);
    335 	DELAY(1000);
    336 	QE_WCSR(QE_CSR_CSR, QE_RCSR(QE_CSR_CSR) & ~QE_RESET);
    337 
    338 	/*
    339 	 * Read out ethernet address and tell which type this card is.
    340 	 */
    341 	for (i = 0; i < 6; i++)
    342 		enaddr[i] = QE_RCSR(i * 2) & 0xff;
    343 
    344 	QE_WCSR(QE_CSR_VECTOR, sc->sc_intvec | 1);
    345 	printf("\n%s: %s, hardware address %s\n", sc->sc_dev.dv_xname,
    346 		QE_RCSR(QE_CSR_VECTOR) & 1 ? "delqa":"deqna",
    347 		ether_sprintf(enaddr));
    348 
    349 	QE_WCSR(QE_CSR_VECTOR, QE_RCSR(QE_CSR_VECTOR) & ~1); /* ??? */
    350 
    351 	uba_intr_establish(ua->ua_icookie, ua->ua_cvec, qeintr,
    352 		sc, &sc->sc_intrcnt);
    353 	evcnt_attach_dynamic(&sc->sc_intrcnt, EVCNT_TYPE_INTR, ua->ua_evcnt,
    354 		sc->sc_dev.dv_xname, "intr");
    355 
    356 	strcpy(ifp->if_xname, sc->sc_dev.dv_xname);
    357 	ifp->if_softc = sc;
    358 	ifp->if_flags = IFF_BROADCAST | IFF_SIMPLEX | IFF_MULTICAST;
    359 	ifp->if_start = qestart;
    360 	ifp->if_ioctl = qeioctl;
    361 	ifp->if_watchdog = qetimeout;
    362 	IFQ_SET_READY(&ifp->if_snd);
    363 
    364 	/*
    365 	 * Attach the interface.
    366 	 */
    367 	if_attach(ifp);
    368 	ether_ifattach(ifp, enaddr);
    369 
    370 	return;
    371 
    372 	/*
    373 	 * Free any resources we've allocated during the failed attach
    374 	 * attempt.  Do this in reverse order and fall through.
    375 	 */
    376  fail_6:
    377 	for (i = 0; i < RXDESCS; i++) {
    378 		if (sc->sc_rxmbuf[i] != NULL) {
    379 			bus_dmamap_unload(sc->sc_dmat, sc->sc_xmtmap[i]);
    380 			m_freem(sc->sc_rxmbuf[i]);
    381 		}
    382 	}
    383  fail_5:
    384 	for (i = 0; i < RXDESCS; i++) {
    385 		if (sc->sc_xmtmap[i] != NULL)
    386 			bus_dmamap_destroy(sc->sc_dmat, sc->sc_xmtmap[i]);
    387 	}
    388  fail_4:
    389 	for (i = 0; i < TXDESCS; i++) {
    390 		if (sc->sc_rcvmap[i] != NULL)
    391 			bus_dmamap_destroy(sc->sc_dmat, sc->sc_rcvmap[i]);
    392 	}
    393 	bus_dmamap_unload(sc->sc_dmat, sc->sc_cmap);
    394  fail_3:
    395 	bus_dmamap_destroy(sc->sc_dmat, sc->sc_cmap);
    396  fail_2:
    397 	bus_dmamem_unmap(sc->sc_dmat, (caddr_t)sc->sc_qedata,
    398 	    sizeof(struct qe_cdata));
    399  fail_1:
    400 	bus_dmamem_free(sc->sc_dmat, &seg, rseg);
    401  fail_0:
    402 	return;
    403 }
    404 
    405 /*
    406  * Initialization of interface.
    407  */
    408 void
    409 qeinit(sc)
    410 	struct qe_softc *sc;
    411 {
    412 	struct ifnet *ifp = (struct ifnet *)&sc->sc_if;
    413 	struct qe_cdata *qc = sc->sc_qedata;
    414 	int i;
    415 
    416 
    417 	/*
    418 	 * Reset the interface.
    419 	 */
    420 	QE_WCSR(QE_CSR_CSR, QE_RESET);
    421 	DELAY(1000);
    422 	QE_WCSR(QE_CSR_CSR, QE_RCSR(QE_CSR_CSR) & ~QE_RESET);
    423 	QE_WCSR(QE_CSR_VECTOR, sc->sc_intvec);
    424 
    425 	sc->sc_nexttx = sc->sc_inq = sc->sc_lastack = 0;
    426 	/*
    427 	 * Release and init transmit descriptors.
    428 	 */
    429 	for (i = 0; i < TXDESCS; i++) {
    430 		if (sc->sc_txmbuf[i]) {
    431 			bus_dmamap_unload(sc->sc_dmat, sc->sc_xmtmap[i]);
    432 			m_freem(sc->sc_txmbuf[i]);
    433 			sc->sc_txmbuf[i] = 0;
    434 		}
    435 		qc->qc_xmit[i].qe_addr_hi = 0; /* Clear valid bit */
    436 		qc->qc_xmit[i].qe_status1 = qc->qc_xmit[i].qe_flag = QE_NOTYET;
    437 	}
    438 
    439 
    440 	/*
    441 	 * Init receive descriptors.
    442 	 */
    443 	for (i = 0; i < RXDESCS; i++)
    444 		qc->qc_recv[i].qe_status1 = qc->qc_recv[i].qe_flag = QE_NOTYET;
    445 	sc->sc_nextrx = 0;
    446 
    447 	/*
    448 	 * Write the descriptor addresses to the device.
    449 	 * Receiving packets will be enabled in the interrupt routine.
    450 	 */
    451 	QE_WCSR(QE_CSR_CSR, QE_INT_ENABLE|QE_XMIT_INT|QE_RCV_INT);
    452 	QE_WCSR(QE_CSR_RCLL, LOWORD(sc->sc_pqedata->qc_recv));
    453 	QE_WCSR(QE_CSR_RCLH, HIWORD(sc->sc_pqedata->qc_recv));
    454 
    455 	ifp->if_flags |= IFF_RUNNING;
    456 	ifp->if_flags &= ~IFF_OACTIVE;
    457 
    458 	/*
    459 	 * Send a setup frame.
    460 	 * This will start the transmit machinery as well.
    461 	 */
    462 	qe_setup(sc);
    463 
    464 }
    465 
    466 /*
    467  * Start output on interface.
    468  */
    469 void
    470 qestart(ifp)
    471 	struct ifnet *ifp;
    472 {
    473 	struct qe_softc *sc = ifp->if_softc;
    474 	struct qe_cdata *qc = sc->sc_qedata;
    475 	paddr_t	buffer;
    476 	struct mbuf *m, *m0;
    477 	int idx, len, s, i, totlen, error;
    478 	short orword;
    479 
    480 	if ((QE_RCSR(QE_CSR_CSR) & QE_RCV_ENABLE) == 0)
    481 		return;
    482 
    483 	s = splimp();
    484 	while (sc->sc_inq < (TXDESCS - 1)) {
    485 
    486 		if (sc->sc_setup) {
    487 			qe_setup(sc);
    488 			continue;
    489 		}
    490 		idx = sc->sc_nexttx;
    491 		IFQ_POLL(&ifp->if_snd, m);
    492 		if (m == 0)
    493 			goto out;
    494 		/*
    495 		 * Count number of mbufs in chain.
    496 		 * Always do DMA directly from mbufs, therefore the transmit
    497 		 * ring is really big.
    498 		 */
    499 		for (m0 = m, i = 0; m0; m0 = m0->m_next)
    500 			if (m0->m_len)
    501 				i++;
    502 		if (i >= TXDESCS)
    503 			panic("qestart");
    504 
    505 		if ((i + sc->sc_inq) >= (TXDESCS - 1)) {
    506 			ifp->if_flags |= IFF_OACTIVE;
    507 			goto out;
    508 		}
    509 
    510 		IFQ_DEQUEUE(&ifp->if_snd, m);
    511 
    512 #if NBPFILTER > 0
    513 		if (ifp->if_bpf)
    514 			bpf_mtap(ifp->if_bpf, m);
    515 #endif
    516 		/*
    517 		 * m now points to a mbuf chain that can be loaded.
    518 		 * Loop around and set it.
    519 		 */
    520 		totlen = 0;
    521 		for (m0 = m; m0; m0 = m0->m_next) {
    522 			error = bus_dmamap_load(sc->sc_dmat, sc->sc_xmtmap[idx],
    523 			    mtod(m0, void *), m0->m_len, 0, 0);
    524 			buffer = sc->sc_xmtmap[idx]->dm_segs[0].ds_addr;
    525 			len = m0->m_len;
    526 			if (len == 0)
    527 				continue;
    528 
    529 			totlen += len;
    530 			/* Word alignment calc */
    531 			orword = 0;
    532 			if (totlen == m->m_pkthdr.len) {
    533 				if (totlen < ETHER_MIN_LEN)
    534 					len += (ETHER_MIN_LEN - totlen);
    535 				orword |= QE_EOMSG;
    536 				sc->sc_txmbuf[idx] = m;
    537 			}
    538 			if ((buffer & 1) || (len & 1))
    539 				len += 2;
    540 			if (buffer & 1)
    541 				orword |= QE_ODDBEGIN;
    542 			if ((buffer + len) & 1)
    543 				orword |= QE_ODDEND;
    544 			qc->qc_xmit[idx].qe_buf_len = -(len/2);
    545 			qc->qc_xmit[idx].qe_addr_lo = LOWORD(buffer);
    546 			qc->qc_xmit[idx].qe_addr_hi = HIWORD(buffer);
    547 			qc->qc_xmit[idx].qe_flag =
    548 			    qc->qc_xmit[idx].qe_status1 = QE_NOTYET;
    549 			qc->qc_xmit[idx].qe_addr_hi |= (QE_VALID | orword);
    550 			if (++idx == TXDESCS)
    551 				idx = 0;
    552 			sc->sc_inq++;
    553 		}
    554 #ifdef DIAGNOSTIC
    555 		if (totlen != m->m_pkthdr.len)
    556 			panic("qestart: len fault");
    557 #endif
    558 
    559 		/*
    560 		 * Kick off the transmit logic, if it is stopped.
    561 		 */
    562 		if (QE_RCSR(QE_CSR_CSR) & QE_XL_INVALID) {
    563 			QE_WCSR(QE_CSR_XMTL,
    564 			    LOWORD(&sc->sc_pqedata->qc_xmit[sc->sc_nexttx]));
    565 			QE_WCSR(QE_CSR_XMTH,
    566 			    HIWORD(&sc->sc_pqedata->qc_xmit[sc->sc_nexttx]));
    567 		}
    568 		sc->sc_nexttx = idx;
    569 	}
    570 	if (sc->sc_inq == (TXDESCS - 1))
    571 		ifp->if_flags |= IFF_OACTIVE;
    572 
    573 out:	if (sc->sc_inq)
    574 		ifp->if_timer = 5; /* If transmit logic dies */
    575 	splx(s);
    576 }
    577 
    578 static void
    579 qeintr(arg)
    580 	void *arg;
    581 {
    582 	struct qe_softc *sc = arg;
    583 	struct qe_cdata *qc = sc->sc_qedata;
    584 	struct ifnet *ifp = &sc->sc_if;
    585 	struct ether_header *eh;
    586 	struct mbuf *m;
    587 	int csr, status1, status2, len;
    588 
    589 	csr = QE_RCSR(QE_CSR_CSR);
    590 
    591 	QE_WCSR(QE_CSR_CSR, QE_RCV_ENABLE | QE_INT_ENABLE | QE_XMIT_INT |
    592 	    QE_RCV_INT | QE_ILOOP);
    593 
    594 	if (csr & QE_RCV_INT)
    595 		while (qc->qc_recv[sc->sc_nextrx].qe_status1 != QE_NOTYET) {
    596 			status1 = qc->qc_recv[sc->sc_nextrx].qe_status1;
    597 			status2 = qc->qc_recv[sc->sc_nextrx].qe_status2;
    598 			m = sc->sc_rxmbuf[sc->sc_nextrx];
    599 			len = ((status1 & QE_RBL_HI) |
    600 			    (status2 & QE_RBL_LO)) + 60;
    601 			qe_add_rxbuf(sc, sc->sc_nextrx);
    602 			m->m_pkthdr.rcvif = ifp;
    603 			m->m_pkthdr.len = m->m_len = len;
    604 			if (++sc->sc_nextrx == RXDESCS)
    605 				sc->sc_nextrx = 0;
    606 			eh = mtod(m, struct ether_header *);
    607 #if NBPFILTER > 0
    608 			if (ifp->if_bpf)
    609 				bpf_mtap(ifp->if_bpf, m);
    610 #endif
    611 			(*ifp->if_input)(ifp, m);
    612 		}
    613 
    614 	if (csr & QE_XMIT_INT) {
    615 		while (qc->qc_xmit[sc->sc_lastack].qe_status1 != QE_NOTYET) {
    616 			int idx = sc->sc_lastack;
    617 
    618 			sc->sc_inq--;
    619 			if (++sc->sc_lastack == TXDESCS)
    620 				sc->sc_lastack = 0;
    621 
    622 			/* XXX collect statistics */
    623 			qc->qc_xmit[idx].qe_addr_hi &= ~QE_VALID;
    624 			qc->qc_xmit[idx].qe_status1 =
    625 			    qc->qc_xmit[idx].qe_flag = QE_NOTYET;
    626 
    627 			if (qc->qc_xmit[idx].qe_addr_hi & QE_SETUP)
    628 				continue;
    629 			bus_dmamap_unload(sc->sc_dmat, sc->sc_xmtmap[idx]);
    630 			if (sc->sc_txmbuf[idx]) {
    631 				m_freem(sc->sc_txmbuf[idx]);
    632 				sc->sc_txmbuf[idx] = 0;
    633 			}
    634 		}
    635 		ifp->if_timer = 0;
    636 		ifp->if_flags &= ~IFF_OACTIVE;
    637 		qestart(ifp); /* Put in more in queue */
    638 	}
    639 	/*
    640 	 * How can the receive list get invalid???
    641 	 * Verified that it happens anyway.
    642 	 */
    643 	if ((qc->qc_recv[sc->sc_nextrx].qe_status1 == QE_NOTYET) &&
    644 	    (QE_RCSR(QE_CSR_CSR) & QE_RL_INVALID)) {
    645 		QE_WCSR(QE_CSR_RCLL,
    646 		    LOWORD(&sc->sc_pqedata->qc_recv[sc->sc_nextrx]));
    647 		QE_WCSR(QE_CSR_RCLH,
    648 		    HIWORD(&sc->sc_pqedata->qc_recv[sc->sc_nextrx]));
    649 	}
    650 }
    651 
    652 /*
    653  * Process an ioctl request.
    654  */
    655 int
    656 qeioctl(ifp, cmd, data)
    657 	struct ifnet *ifp;
    658 	u_long cmd;
    659 	caddr_t data;
    660 {
    661 	struct qe_softc *sc = ifp->if_softc;
    662 	struct ifreq *ifr = (struct ifreq *)data;
    663 	struct ifaddr *ifa = (struct ifaddr *)data;
    664 	int s = splnet(), error = 0;
    665 
    666 	switch (cmd) {
    667 
    668 	case SIOCSIFADDR:
    669 		ifp->if_flags |= IFF_UP;
    670 		switch(ifa->ifa_addr->sa_family) {
    671 #ifdef INET
    672 		case AF_INET:
    673 			qeinit(sc);
    674 			arp_ifinit(ifp, ifa);
    675 			break;
    676 #endif
    677 		}
    678 		break;
    679 
    680 	case SIOCSIFFLAGS:
    681 		if ((ifp->if_flags & IFF_UP) == 0 &&
    682 		    (ifp->if_flags & IFF_RUNNING) != 0) {
    683 			/*
    684 			 * If interface is marked down and it is running,
    685 			 * stop it. (by disabling receive mechanism).
    686 			 */
    687 			QE_WCSR(QE_CSR_CSR,
    688 			    QE_RCSR(QE_CSR_CSR) & ~QE_RCV_ENABLE);
    689 			ifp->if_flags &= ~IFF_RUNNING;
    690 		} else if ((ifp->if_flags & IFF_UP) != 0 &&
    691 			   (ifp->if_flags & IFF_RUNNING) == 0) {
    692 			/*
    693 			 * If interface it marked up and it is stopped, then
    694 			 * start it.
    695 			 */
    696 			qeinit(sc);
    697 		} else if ((ifp->if_flags & IFF_UP) != 0) {
    698 			/*
    699 			 * Send a new setup packet to match any new changes.
    700 			 * (Like IFF_PROMISC etc)
    701 			 */
    702 			qe_setup(sc);
    703 		}
    704 		break;
    705 
    706 	case SIOCADDMULTI:
    707 	case SIOCDELMULTI:
    708 		/*
    709 		 * Update our multicast list.
    710 		 */
    711 		error = (cmd == SIOCADDMULTI) ?
    712 			ether_addmulti(ifr, &sc->sc_ec):
    713 			ether_delmulti(ifr, &sc->sc_ec);
    714 
    715 		if (error == ENETRESET) {
    716 			/*
    717 			 * Multicast list has changed; set the hardware filter
    718 			 * accordingly.
    719 			 */
    720 			qe_setup(sc);
    721 			error = 0;
    722 		}
    723 		break;
    724 
    725 	default:
    726 		error = EINVAL;
    727 
    728 	}
    729 	splx(s);
    730 	return (error);
    731 }
    732 
    733 /*
    734  * Add a receive buffer to the indicated descriptor.
    735  */
    736 int
    737 qe_add_rxbuf(sc, i)
    738 	struct qe_softc *sc;
    739 	int i;
    740 {
    741 	struct mbuf *m;
    742 	struct qe_ring *rp;
    743 	vaddr_t addr;
    744 	int error;
    745 
    746 	MGETHDR(m, M_DONTWAIT, MT_DATA);
    747 	if (m == NULL)
    748 		return (ENOBUFS);
    749 
    750 	MCLGET(m, M_DONTWAIT);
    751 	if ((m->m_flags & M_EXT) == 0) {
    752 		m_freem(m);
    753 		return (ENOBUFS);
    754 	}
    755 
    756 	if (sc->sc_rxmbuf[i] != NULL)
    757 		bus_dmamap_unload(sc->sc_dmat, sc->sc_rcvmap[i]);
    758 
    759 	error = bus_dmamap_load(sc->sc_dmat, sc->sc_rcvmap[i],
    760 	    m->m_ext.ext_buf, m->m_ext.ext_size, NULL, BUS_DMA_NOWAIT);
    761 	if (error)
    762 		panic("%s: can't load rx DMA map %d, error = %d\n",
    763 		    sc->sc_dev.dv_xname, i, error);
    764 	sc->sc_rxmbuf[i] = m;
    765 
    766 	bus_dmamap_sync(sc->sc_dmat, sc->sc_rcvmap[i], 0,
    767 	    sc->sc_rcvmap[i]->dm_mapsize, BUS_DMASYNC_PREREAD);
    768 
    769 	/*
    770 	 * We know that the mbuf cluster is page aligned. Also, be sure
    771 	 * that the IP header will be longword aligned.
    772 	 */
    773 	m->m_data += 2;
    774 	addr = sc->sc_rcvmap[i]->dm_segs[0].ds_addr + 2;
    775 	rp = &sc->sc_qedata->qc_recv[i];
    776 	rp->qe_flag = rp->qe_status1 = QE_NOTYET;
    777 	rp->qe_addr_lo = LOWORD(addr);
    778 	rp->qe_addr_hi = HIWORD(addr) | QE_VALID;
    779 	rp->qe_buf_len = -(m->m_ext.ext_size - 2)/2;
    780 
    781 	return (0);
    782 }
    783 
    784 /*
    785  * Create a setup packet and put in queue for sending.
    786  */
    787 void
    788 qe_setup(sc)
    789 	struct qe_softc *sc;
    790 {
    791 	struct ether_multi *enm;
    792 	struct ether_multistep step;
    793 	struct qe_cdata *qc = sc->sc_qedata;
    794 	struct ifnet *ifp = &sc->sc_if;
    795 	u_int8_t *enaddr = LLADDR(ifp->if_sadl);
    796 	int i, j, k, idx, s;
    797 
    798 	s = splimp();
    799 	if (sc->sc_inq == (TXDESCS - 1)) {
    800 		sc->sc_setup = 1;
    801 		splx(s);
    802 		return;
    803 	}
    804 	sc->sc_setup = 0;
    805 	/*
    806 	 * Init the setup packet with valid info.
    807 	 */
    808 	memset(qc->qc_setup, 0xff, sizeof(qc->qc_setup)); /* Broadcast */
    809 	for (i = 0; i < ETHER_ADDR_LEN; i++)
    810 		qc->qc_setup[i * 8 + 1] = enaddr[i]; /* Own address */
    811 
    812 	/*
    813 	 * Multicast handling. The DEQNA can handle up to 12 direct
    814 	 * ethernet addresses.
    815 	 */
    816 	j = 3; k = 0;
    817 	ifp->if_flags &= ~IFF_ALLMULTI;
    818 	ETHER_FIRST_MULTI(step, &sc->sc_ec, enm);
    819 	while (enm != NULL) {
    820 		if (bcmp(enm->enm_addrlo, enm->enm_addrhi, 6)) {
    821 			ifp->if_flags |= IFF_ALLMULTI;
    822 			break;
    823 		}
    824 		for (i = 0; i < ETHER_ADDR_LEN; i++)
    825 			qc->qc_setup[i * 8 + j + k] = enm->enm_addrlo[i];
    826 		j++;
    827 		if (j == 8) {
    828 			j = 1; k += 64;
    829 		}
    830 		if (k > 64) {
    831 			ifp->if_flags |= IFF_ALLMULTI;
    832 			break;
    833 		}
    834 		ETHER_NEXT_MULTI(step, enm);
    835 	}
    836 	idx = sc->sc_nexttx;
    837 	qc->qc_xmit[idx].qe_buf_len = -64;
    838 
    839 	/*
    840 	 * How is the DEQNA turned in ALLMULTI mode???
    841 	 * Until someone tells me, fall back to PROMISC when more than
    842 	 * 12 ethernet addresses.
    843 	 */
    844 	if (ifp->if_flags & IFF_ALLMULTI)
    845 		ifp->if_flags |= IFF_PROMISC;
    846 	else if (ifp->if_pcount == 0)
    847 		ifp->if_flags &= ~IFF_PROMISC;
    848 	if (ifp->if_flags & IFF_PROMISC)
    849 		qc->qc_xmit[idx].qe_buf_len = -65;
    850 
    851 	qc->qc_xmit[idx].qe_addr_lo = LOWORD(sc->sc_pqedata->qc_setup);
    852 	qc->qc_xmit[idx].qe_addr_hi =
    853 	    HIWORD(sc->sc_pqedata->qc_setup) | QE_SETUP | QE_EOMSG;
    854 	qc->qc_xmit[idx].qe_status1 = qc->qc_xmit[idx].qe_flag = QE_NOTYET;
    855 	qc->qc_xmit[idx].qe_addr_hi |= QE_VALID;
    856 
    857 	if (QE_RCSR(QE_CSR_CSR) & QE_XL_INVALID) {
    858 		QE_WCSR(QE_CSR_XMTL,
    859 		    LOWORD(&sc->sc_pqedata->qc_xmit[idx]));
    860 		QE_WCSR(QE_CSR_XMTH,
    861 		    HIWORD(&sc->sc_pqedata->qc_xmit[idx]));
    862 	}
    863 
    864 	sc->sc_inq++;
    865 	if (++sc->sc_nexttx == TXDESCS)
    866 		sc->sc_nexttx = 0;
    867 	splx(s);
    868 }
    869 
    870 /*
    871  * Check for dead transmit logic. Not uncommon.
    872  */
    873 void
    874 qetimeout(ifp)
    875 	struct ifnet *ifp;
    876 {
    877 	struct qe_softc *sc = ifp->if_softc;
    878 
    879 	if (sc->sc_inq == 0)
    880 		return;
    881 
    882 	printf("%s: xmit logic died, resetting...\n", sc->sc_dev.dv_xname);
    883 	/*
    884 	 * Do a reset of interface, to get it going again.
    885 	 * Will it work by just restart the transmit logic?
    886 	 */
    887 	qeinit(sc);
    888 }
    889