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