Home | History | Annotate | Line # | Download | only in qbus
if_qe.c revision 1.47
      1  1.47   thorpej /*      $NetBSD: if_qe.c,v 1.47 2001/04/12 20:04:24 thorpej 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.41      matt 	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.46     ragge static	int	qematch(struct device *, struct cfdata *, void *);
    106  1.46     ragge static	void	qeattach(struct device *, struct device *, void *);
    107  1.46     ragge static	void	qeinit(struct qe_softc *);
    108  1.46     ragge static	void	qestart(struct ifnet *);
    109  1.46     ragge static	void	qeintr(void *);
    110  1.46     ragge static	int	qeioctl(struct ifnet *, u_long, caddr_t);
    111  1.46     ragge static	int	qe_add_rxbuf(struct qe_softc *, int);
    112  1.46     ragge static	void	qe_setup(struct qe_softc *);
    113  1.46     ragge 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.46     ragge 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.46     ragge 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.41      matt 	uba_intr_establish(ua->ua_icookie, ua->ua_cvec, qeintr,
    347  1.41      matt 		sc, &sc->sc_intrcnt);
    348  1.42      matt 	evcnt_attach_dynamic(&sc->sc_intrcnt, EVCNT_TYPE_INTR, ua->ua_evcnt,
    349  1.42      matt 		sc->sc_dev.dv_xname, "intr");
    350  1.39      matt 
    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.45   thorpej 	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.46     ragge 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.46     ragge 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.46     ragge 	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.47   thorpej 	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.45   thorpej 		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.45   thorpej 
    503  1.45   thorpej 		IFQ_DEQUEUE(&ifp->if_snd, m);
    504  1.45   thorpej 
    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.46     ragge 		csr = QE_RCSR(QE_CSR_CSR);
    556  1.46     ragge 		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.39      matt static void
    573  1.46     ragge qeintr(void *arg)
    574   1.1     ragge {
    575  1.39      matt 	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.46     ragge 
    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.43   thorpej 			if (ifp->if_bpf)
    601  1.37     ragge 				bpf_mtap(ifp->if_bpf, m);
    602  1.37     ragge #endif
    603  1.46     ragge 			if ((status1 & QE_ESETUP) == 0)
    604  1.46     ragge 				(*ifp->if_input)(ifp, m);
    605  1.46     ragge 			else
    606  1.46     ragge 				m_freem(m);
    607   1.1     ragge 		}
    608  1.37     ragge 
    609  1.46     ragge 	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.46     ragge 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.46     ragge 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.46     ragge 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.47   thorpej 	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.43   thorpej 	if (ifp->if_flags & IFF_ALLMULTI)
    834  1.43   thorpej 		ifp->if_flags |= IFF_PROMISC;
    835  1.43   thorpej 	else if (ifp->if_pcount == 0)
    836  1.43   thorpej 		ifp->if_flags &= ~IFF_PROMISC;
    837  1.43   thorpej 	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.46     ragge 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