Home | History | Annotate | Line # | Download | only in bi
if_ni.c revision 1.30
      1  1.30        he /*	$NetBSD: if_ni.c,v 1.30 2007/03/08 23:17:56 he Exp $ */
      2   1.1     ragge /*
      3   1.1     ragge  * Copyright (c) 2000 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.25     perry  *	This product includes software developed at Ludd, University of
     16   1.1     ragge  *	Lule}, Sweden and its contributors.
     17   1.1     ragge  * 4. The name of the author may not be used to endorse or promote products
     18   1.1     ragge  *    derived from this software without specific prior written permission
     19   1.1     ragge  *
     20   1.1     ragge  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
     21   1.1     ragge  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
     22   1.1     ragge  * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
     23   1.1     ragge  * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
     24   1.1     ragge  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
     25   1.1     ragge  * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
     26   1.1     ragge  * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
     27   1.1     ragge  * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
     28   1.1     ragge  * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
     29   1.1     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.1     ragge  * Driver for DEBNA/DEBNT/DEBNK ethernet cards.
     34   1.1     ragge  * Things that is still to do:
     35   1.1     ragge  *	Collect statistics.
     36   1.1     ragge  */
     37  1.14     lukem 
     38  1.14     lukem #include <sys/cdefs.h>
     39  1.30        he __KERNEL_RCSID(0, "$NetBSD: if_ni.c,v 1.30 2007/03/08 23:17:56 he Exp $");
     40   1.1     ragge 
     41   1.1     ragge #include "opt_inet.h"
     42   1.1     ragge #include "bpfilter.h"
     43   1.1     ragge 
     44   1.1     ragge #include <sys/param.h>
     45   1.1     ragge #include <sys/mbuf.h>
     46   1.1     ragge #include <sys/socket.h>
     47   1.1     ragge #include <sys/device.h>
     48   1.1     ragge #include <sys/systm.h>
     49   1.1     ragge #include <sys/sockio.h>
     50  1.11     ragge #include <sys/sched.h>
     51   1.1     ragge 
     52  1.21   thorpej #include <uvm/uvm_extern.h>
     53  1.21   thorpej 
     54   1.1     ragge #include <net/if.h>
     55   1.1     ragge #include <net/if_ether.h>
     56   1.1     ragge #include <net/if_dl.h>
     57   1.1     ragge 
     58   1.1     ragge #include <netinet/in.h>
     59   1.1     ragge #include <netinet/if_inarp.h>
     60   1.1     ragge 
     61   1.1     ragge #if NBPFILTER > 0
     62   1.1     ragge #include <net/bpf.h>
     63   1.1     ragge #include <net/bpfdesc.h>
     64   1.1     ragge #endif
     65   1.1     ragge 
     66   1.1     ragge #include <machine/bus.h>
     67   1.1     ragge #ifdef __vax__
     68   1.1     ragge #include <machine/mtpr.h>
     69   1.1     ragge #include <machine/pte.h>
     70   1.1     ragge #endif
     71   1.1     ragge 
     72   1.1     ragge #include <dev/bi/bireg.h>
     73   1.1     ragge #include <dev/bi/bivar.h>
     74   1.1     ragge 
     75   1.1     ragge #include "ioconf.h"
     76   1.1     ragge #include "locators.h"
     77   1.1     ragge 
     78   1.1     ragge /*
     79   1.1     ragge  * Tunable buffer parameters. Good idea to have them as power of 8; then
     80   1.1     ragge  * they will fit into a logical VAX page.
     81   1.1     ragge  */
     82   1.1     ragge #define NMSGBUF		8	/* Message queue entries */
     83   1.1     ragge #define NTXBUF		16	/* Transmit queue entries */
     84   1.1     ragge #define NTXFRAGS	8	/* Number of transmit buffer fragments */
     85   1.1     ragge #define NRXBUF		24	/* Receive queue entries */
     86   1.1     ragge #define NBDESCS		(NTXBUF * NTXFRAGS + NRXBUF)
     87   1.1     ragge #define NQUEUES		3	/* RX + TX + MSG */
     88   1.1     ragge #define PKTHDR		18	/* Length of (control) packet header */
     89   1.1     ragge #define RXADD		18	/* Additional length of receive datagram */
     90   1.1     ragge #define TXADD		(10+NTXFRAGS*8) /*	""	transmit   ""	 */
     91   1.1     ragge #define MSGADD		134	/*		""	message	   ""	 */
     92   1.1     ragge 
     93   1.1     ragge #include <dev/bi/if_nireg.h>	/* XXX include earlier */
     94   1.1     ragge 
     95   1.1     ragge /*
     96   1.1     ragge  * Macros for (most cases of) insqti/remqhi.
     97   1.1     ragge  * Retry NRETRIES times to do the operation, if it still fails assume
     98   1.1     ragge  * a lost lock and panic.
     99   1.1     ragge  */
    100   1.1     ragge #define	NRETRIES	100
    101   1.1     ragge #define	INSQTI(e, h)	({						\
    102  1.26     ragge 	int ret = 0, __i;						\
    103  1.26     ragge 	for (__i = 0; __i < NRETRIES; __i++) {				\
    104   1.1     ragge 		if ((ret = insqti(e, h)) != ILCK_FAILED)		\
    105   1.1     ragge 			break;						\
    106   1.1     ragge 	}								\
    107  1.26     ragge 	if (__i == NRETRIES)						\
    108   1.1     ragge 		panic("ni: insqti failed at %d", __LINE__);		\
    109   1.1     ragge 	ret;								\
    110   1.1     ragge })
    111   1.1     ragge #define	REMQHI(h)	({						\
    112  1.26     ragge 	int __i; void *ret = NULL;					\
    113  1.26     ragge 	for (__i = 0; __i < NRETRIES; __i++) {				\
    114   1.1     ragge 		if ((ret = remqhi(h)) != (void *)ILCK_FAILED)		\
    115   1.1     ragge 			break;						\
    116   1.1     ragge 	}								\
    117  1.26     ragge 	if (__i == NRETRIES)						\
    118   1.1     ragge 		panic("ni: remqhi failed at %d", __LINE__);		\
    119   1.1     ragge 	ret;								\
    120   1.1     ragge })
    121   1.1     ragge 
    122   1.1     ragge 
    123   1.1     ragge #define nipqb	(&sc->sc_gvppqb->nc_pqb)
    124   1.1     ragge #define gvp	sc->sc_gvppqb
    125   1.1     ragge #define fqb	sc->sc_fqb
    126   1.1     ragge #define bbd	sc->sc_bbd
    127   1.1     ragge 
    128   1.1     ragge struct	ni_softc {
    129   1.1     ragge 	struct device	sc_dev;		/* Configuration common part	*/
    130   1.4      matt 	struct evcnt	sc_intrcnt;	/* Interrupt coounting		*/
    131   1.1     ragge 	struct ethercom sc_ec;		/* Ethernet common part		*/
    132   1.1     ragge #define sc_if	sc_ec.ec_if		/* network-visible interface	*/
    133   1.1     ragge 	bus_space_tag_t sc_iot;
    134   1.1     ragge 	bus_addr_t	sc_ioh;
    135   1.1     ragge 	bus_dma_tag_t	sc_dmat;
    136   1.1     ragge 	struct ni_gvppqb *sc_gvppqb;	/* Port queue block		*/
    137   1.1     ragge 	struct ni_gvppqb *sc_pgvppqb;	/* Phys address of PQB		*/
    138   1.1     ragge 	struct ni_fqb	*sc_fqb;	/* Free Queue block		*/
    139   1.1     ragge 	struct ni_bbd	*sc_bbd;	/* Buffer descriptors		*/
    140   1.1     ragge 	u_int8_t	sc_enaddr[ETHER_ADDR_LEN];
    141   1.1     ragge };
    142   1.1     ragge 
    143  1.24     perry static	int	nimatch(struct device *, struct cfdata *, void *);
    144  1.24     perry static	void	niattach(struct device *, struct device *, void *);
    145  1.24     perry static	void	niinit(struct ni_softc *);
    146  1.24     perry static	void	nistart(struct ifnet *);
    147  1.24     perry static	void	niintr(void *);
    148  1.29  christos static	int	niioctl(struct ifnet *, u_long, void *);
    149   1.1     ragge static	int	ni_add_rxbuf(struct ni_softc *, struct ni_dg *, int);
    150  1.24     perry static	void	ni_setup(struct ni_softc *);
    151  1.24     perry static	void	nitimeout(struct ifnet *);
    152   1.2     ragge static	void	ni_shutdown(void *);
    153  1.29  christos static	void ni_getpgs(struct ni_softc *sc, int size, void **v, paddr_t *p);
    154  1.26     ragge static	int failtest(struct ni_softc *, int, int, int, const char *);
    155   1.1     ragge 
    156   1.2     ragge volatile int endwait, retry;	/* Used during autoconfig */
    157   1.1     ragge 
    158  1.17   thorpej CFATTACH_DECL(ni, sizeof(struct ni_softc),
    159  1.18   thorpej     nimatch, niattach, NULL, NULL);
    160   1.1     ragge 
    161   1.1     ragge #define NI_WREG(csr, val) \
    162   1.1     ragge 	bus_space_write_4(sc->sc_iot, sc->sc_ioh, csr, val)
    163   1.1     ragge #define NI_RREG(csr) \
    164   1.1     ragge 	bus_space_read_4(sc->sc_iot, sc->sc_ioh, csr)
    165   1.1     ragge 
    166   1.1     ragge #define WAITREG(csr,val) while (NI_RREG(csr) & val);
    167   1.1     ragge /*
    168   1.1     ragge  * Check for present device.
    169   1.1     ragge  */
    170   1.1     ragge int
    171   1.1     ragge nimatch(parent, cf, aux)
    172   1.1     ragge 	struct	device *parent;
    173   1.1     ragge 	struct	cfdata *cf;
    174   1.1     ragge 	void	*aux;
    175   1.1     ragge {
    176   1.1     ragge 	struct bi_attach_args *ba = aux;
    177   1.1     ragge 	u_short type;
    178   1.1     ragge 
    179   1.1     ragge 	type = bus_space_read_2(ba->ba_iot, ba->ba_ioh, BIREG_DTYPE);
    180   1.1     ragge 	if (type != BIDT_DEBNA && type != BIDT_DEBNT && type != BIDT_DEBNK)
    181   1.1     ragge 		return 0;
    182   1.1     ragge 
    183   1.1     ragge 	if (cf->cf_loc[BICF_NODE] != BICF_NODE_DEFAULT &&
    184   1.1     ragge 	    cf->cf_loc[BICF_NODE] != ba->ba_nodenr)
    185   1.1     ragge 		return 0;
    186   1.1     ragge 
    187   1.1     ragge 	return 1;
    188   1.1     ragge }
    189   1.1     ragge 
    190   1.1     ragge /*
    191   1.1     ragge  * Allocate a bunch of descriptor-safe memory.
    192   1.1     ragge  * We need to get the structures from the beginning of its own pages.
    193   1.1     ragge  */
    194   1.1     ragge static void
    195  1.29  christos ni_getpgs(struct ni_softc *sc, int size, void **v, paddr_t *p)
    196   1.1     ragge {
    197   1.1     ragge 	bus_dma_segment_t seg;
    198   1.1     ragge 	int nsegs, error;
    199   1.1     ragge 
    200  1.21   thorpej 	if ((error = bus_dmamem_alloc(sc->sc_dmat, size, PAGE_SIZE, 0, &seg, 1,
    201   1.1     ragge 	    &nsegs, BUS_DMA_NOWAIT)) != 0)
    202   1.1     ragge 		panic(" unable to allocate memory: error %d", error);
    203   1.1     ragge 
    204   1.1     ragge 	if ((error = bus_dmamem_map(sc->sc_dmat, &seg, nsegs, size, v,
    205   1.1     ragge 	    BUS_DMA_NOWAIT|BUS_DMA_COHERENT)) != 0)
    206   1.1     ragge 		panic(" unable to map memory: error %d", error);
    207   1.1     ragge 
    208   1.1     ragge 	if (p)
    209   1.1     ragge 		*p = seg.ds_addr;
    210  1.12   thorpej 	memset(*v, 0, size);
    211   1.1     ragge }
    212   1.1     ragge 
    213   1.2     ragge static int
    214  1.26     ragge failtest(struct ni_softc *sc, int reg, int mask, int test, const char *str)
    215   1.2     ragge {
    216   1.2     ragge 	int i = 100;
    217   1.2     ragge 
    218   1.2     ragge 	do {
    219   1.2     ragge 		DELAY(100000);
    220   1.2     ragge 	} while (((NI_RREG(reg) & mask) != test) && --i);
    221   1.2     ragge 
    222   1.2     ragge 	if (i == 0) {
    223   1.2     ragge 		printf("%s: %s\n", sc->sc_dev.dv_xname, str);
    224   1.2     ragge 		return 1;
    225   1.2     ragge 	}
    226   1.2     ragge 	return 0;
    227   1.2     ragge }
    228   1.2     ragge 
    229   1.2     ragge 
    230   1.1     ragge /*
    231   1.1     ragge  * Interface exists: make available by filling in network interface
    232   1.1     ragge  * record.  System will initialize the interface when it is ready
    233   1.1     ragge  * to accept packets.
    234   1.1     ragge  */
    235   1.1     ragge void
    236   1.1     ragge niattach(parent, self, aux)
    237   1.1     ragge 	struct	device *parent, *self;
    238   1.1     ragge 	void	*aux;
    239   1.1     ragge {
    240   1.1     ragge 	struct bi_attach_args *ba = aux;
    241   1.1     ragge 	struct ni_softc *sc = (struct ni_softc *)self;
    242   1.1     ragge 	struct ifnet *ifp = (struct ifnet *)&sc->sc_if;
    243   1.1     ragge 	struct ni_msg *msg;
    244   1.1     ragge 	struct ni_ptdb *ptdb;
    245  1.29  christos 	void *va;
    246   1.2     ragge 	int i, j, s, res;
    247   1.1     ragge 	u_short type;
    248   1.1     ragge 
    249   1.1     ragge 	type = bus_space_read_2(ba->ba_iot, ba->ba_ioh, BIREG_DTYPE);
    250   1.1     ragge 	printf(": DEBN%c\n", type == BIDT_DEBNA ? 'A' : type == BIDT_DEBNT ?
    251   1.1     ragge 	    'T' : 'K');
    252   1.1     ragge 	sc->sc_iot = ba->ba_iot;
    253   1.1     ragge 	sc->sc_ioh = ba->ba_ioh;
    254   1.1     ragge 	sc->sc_dmat = ba->ba_dmat;
    255   1.1     ragge 
    256   1.4      matt 	bi_intr_establish(ba->ba_icookie, ba->ba_ivec,
    257   1.4      matt 		niintr, sc, &sc->sc_intrcnt);
    258   1.5      matt 	evcnt_attach_dynamic(&sc->sc_intrcnt, EVCNT_TYPE_INTR, NULL,
    259   1.5      matt 		sc->sc_dev.dv_xname, "intr");
    260   1.1     ragge 
    261  1.29  christos 	ni_getpgs(sc, sizeof(struct ni_gvppqb), (void **)&sc->sc_gvppqb,
    262   1.1     ragge 	    (paddr_t *)&sc->sc_pgvppqb);
    263  1.29  christos 	ni_getpgs(sc, sizeof(struct ni_fqb), (void **)&sc->sc_fqb, 0);
    264   1.1     ragge 	ni_getpgs(sc, NBDESCS * sizeof(struct ni_bbd),
    265  1.29  christos 	    (void **)&sc->sc_bbd, 0);
    266   1.1     ragge 	/*
    267   1.1     ragge 	 * Zero the newly allocated memory.
    268   1.1     ragge 	 */
    269   1.1     ragge 
    270   1.1     ragge 	nipqb->np_veclvl = (ba->ba_ivec << 2) + 2;
    271   1.1     ragge 	nipqb->np_node = ba->ba_intcpu;
    272   1.1     ragge 	nipqb->np_vpqb = (u_int32_t)gvp;
    273   1.1     ragge #ifdef __vax__
    274   1.1     ragge 	nipqb->np_spt = nipqb->np_gpt = mfpr(PR_SBR);
    275   1.1     ragge 	nipqb->np_sptlen = nipqb->np_gptlen = mfpr(PR_SLR);
    276   1.1     ragge #else
    277   1.1     ragge #error Must fix support for non-vax.
    278   1.1     ragge #endif
    279   1.1     ragge 	nipqb->np_bvplvl = 1;
    280   1.1     ragge 	nipqb->np_vfqb = (u_int32_t)fqb;
    281   1.1     ragge 	nipqb->np_vbdt = (u_int32_t)bbd;
    282   1.1     ragge 	nipqb->np_nbdr = NBDESCS;
    283   1.1     ragge 
    284   1.1     ragge 	/* Free queue block */
    285   1.1     ragge 	nipqb->np_freeq = NQUEUES;
    286   1.1     ragge 	fqb->nf_mlen = PKTHDR+MSGADD;
    287   1.1     ragge 	fqb->nf_dlen = PKTHDR+TXADD;
    288   1.1     ragge 	fqb->nf_rlen = PKTHDR+RXADD;
    289   1.1     ragge 
    290   1.1     ragge 	strcpy(ifp->if_xname, sc->sc_dev.dv_xname);
    291   1.1     ragge 	ifp->if_softc = sc;
    292   1.1     ragge 	ifp->if_flags = IFF_BROADCAST | IFF_SIMPLEX | IFF_MULTICAST;
    293   1.1     ragge 	ifp->if_start = nistart;
    294   1.1     ragge 	ifp->if_ioctl = niioctl;
    295   1.1     ragge 	ifp->if_watchdog = nitimeout;
    296   1.8   thorpej 	IFQ_SET_READY(&ifp->if_snd);
    297   1.1     ragge 
    298   1.1     ragge 	/*
    299   1.1     ragge 	 * Start init sequence.
    300   1.1     ragge 	 */
    301   1.2     ragge 
    302   1.2     ragge 	/* Reset the node */
    303   1.2     ragge 	NI_WREG(BIREG_VAXBICSR, NI_RREG(BIREG_VAXBICSR) | BICSR_NRST);
    304   1.2     ragge 	DELAY(500000);
    305   1.2     ragge 	i = 20;
    306   1.2     ragge 	while ((NI_RREG(BIREG_VAXBICSR) & BICSR_BROKE) && --i)
    307   1.2     ragge 		DELAY(500000);
    308   1.2     ragge 	if (i == 0) {
    309   1.2     ragge 		printf("%s: BROKE bit set after reset\n", sc->sc_dev.dv_xname);
    310   1.2     ragge 		return;
    311   1.2     ragge 	}
    312   1.2     ragge 
    313   1.1     ragge 	/* Check state */
    314   1.2     ragge 	if (failtest(sc, NI_PSR, PSR_STATE, PSR_UNDEF, "not undefined state"))
    315   1.1     ragge 		return;
    316   1.1     ragge 
    317   1.1     ragge 	/* Clear owner bits */
    318   1.1     ragge 	NI_WREG(NI_PSR, NI_RREG(NI_PSR) & ~PSR_OWN);
    319   1.1     ragge 	NI_WREG(NI_PCR, NI_RREG(NI_PCR) & ~PCR_OWN);
    320   1.1     ragge 
    321   1.1     ragge 	/* kick off init */
    322   1.1     ragge 	NI_WREG(NI_PCR, (u_int32_t)sc->sc_pgvppqb | PCR_INIT | PCR_OWN);
    323   1.1     ragge 	while (NI_RREG(NI_PCR) & PCR_OWN)
    324   1.1     ragge 		DELAY(100000);
    325   1.1     ragge 
    326   1.1     ragge 	/* Check state */
    327   1.2     ragge 	if (failtest(sc, NI_PSR, PSR_INITED, PSR_INITED, "failed initialize"))
    328   1.1     ragge 		return;
    329   1.2     ragge 
    330   1.1     ragge 	NI_WREG(NI_PSR, NI_RREG(NI_PSR) & ~PSR_OWN);
    331   1.1     ragge 
    332   1.1     ragge 	WAITREG(NI_PCR, PCR_OWN);
    333   1.1     ragge 	NI_WREG(NI_PCR, PCR_OWN|PCR_ENABLE);
    334   1.1     ragge 	WAITREG(NI_PCR, PCR_OWN);
    335   1.1     ragge 	WAITREG(NI_PSR, PSR_OWN);
    336   1.1     ragge 
    337   1.1     ragge 	/* Check state */
    338   1.2     ragge 	if (failtest(sc, NI_PSR, PSR_STATE, PSR_ENABLED, "failed enable"))
    339   1.1     ragge 		return;
    340   1.2     ragge 
    341   1.1     ragge 	NI_WREG(NI_PSR, NI_RREG(NI_PSR) & ~PSR_OWN);
    342   1.1     ragge 
    343   1.1     ragge 	/*
    344   1.1     ragge 	 * The message queue packets must be located on the beginning
    345   1.1     ragge 	 * of a page. A VAX page is 512 bytes, but it clusters 8 pages.
    346   1.1     ragge 	 * This knowledge is used here when allocating pages.
    347   1.1     ragge 	 * !!! How should this be done on MIPS and Alpha??? !!!
    348   1.1     ragge 	 */
    349   1.1     ragge #if NBPG < 4096
    350   1.1     ragge #error pagesize too small
    351   1.1     ragge #endif
    352   1.9   thorpej 	s = splvm();
    353   1.1     ragge 	/* Set up message free queue */
    354   1.1     ragge 	ni_getpgs(sc, NMSGBUF * 512, &va, 0);
    355   1.1     ragge 	for (i = 0; i < NMSGBUF; i++) {
    356  1.30        he 		msg = (void *)((char *)va + i * 512);
    357   1.1     ragge 		res = INSQTI(msg, &fqb->nf_mforw);
    358   1.1     ragge 	}
    359   1.1     ragge 	WAITREG(NI_PCR, PCR_OWN);
    360   1.1     ragge 	NI_WREG(NI_PCR, PCR_FREEQNE|PCR_MFREEQ|PCR_OWN);
    361   1.1     ragge 	WAITREG(NI_PCR, PCR_OWN);
    362   1.1     ragge 
    363   1.1     ragge 	/* Set up xmit queue */
    364   1.1     ragge 	ni_getpgs(sc, NTXBUF * 512, &va, 0);
    365   1.1     ragge 	for (i = 0; i < NTXBUF; i++) {
    366   1.1     ragge 		struct ni_dg *data;
    367   1.1     ragge 
    368  1.30        he 		data = (void *)((char *)va + i * 512);
    369   1.1     ragge 		data->nd_status = 0;
    370   1.1     ragge 		data->nd_len = TXADD;
    371   1.1     ragge 		data->nd_ptdbidx = 1;
    372   1.1     ragge 		data->nd_opcode = BVP_DGRAM;
    373   1.1     ragge 		for (j = 0; j < NTXFRAGS; j++) {
    374   1.1     ragge 			data->bufs[j]._offset = 0;
    375   1.1     ragge 			data->bufs[j]._key = 1;
    376   1.1     ragge 			bbd[i * NTXFRAGS + j].nb_key = 1;
    377   1.1     ragge 			bbd[i * NTXFRAGS + j].nb_status = 0;
    378   1.1     ragge 			data->bufs[j]._index = i * NTXFRAGS + j;
    379   1.1     ragge 		}
    380   1.1     ragge 		res = INSQTI(data, &fqb->nf_dforw);
    381   1.1     ragge 	}
    382   1.1     ragge 	WAITREG(NI_PCR, PCR_OWN);
    383   1.1     ragge 	NI_WREG(NI_PCR, PCR_FREEQNE|PCR_DFREEQ|PCR_OWN);
    384   1.1     ragge 	WAITREG(NI_PCR, PCR_OWN);
    385   1.1     ragge 
    386   1.1     ragge 	/* recv buffers */
    387   1.1     ragge 	ni_getpgs(sc, NRXBUF * 512, &va, 0);
    388   1.1     ragge 	for (i = 0; i < NRXBUF; i++) {
    389   1.1     ragge 		struct ni_dg *data;
    390   1.1     ragge 		int idx;
    391   1.1     ragge 
    392  1.30        he 		data = (void *)((char *)va + i * 512);
    393   1.1     ragge 		data->nd_len = RXADD;
    394   1.1     ragge 		data->nd_opcode = BVP_DGRAMRX;
    395   1.1     ragge 		data->nd_ptdbidx = 2;
    396   1.1     ragge 		data->bufs[0]._key = 1;
    397   1.1     ragge 
    398   1.1     ragge 		idx = NTXBUF * NTXFRAGS + i;
    399   1.1     ragge 		if (ni_add_rxbuf(sc, data, idx))
    400   1.1     ragge 			panic("niattach: ni_add_rxbuf: out of mbufs");
    401   1.1     ragge 
    402   1.1     ragge 		res = INSQTI(data, &fqb->nf_rforw);
    403   1.1     ragge 	}
    404   1.1     ragge 	WAITREG(NI_PCR, PCR_OWN);
    405   1.1     ragge 	NI_WREG(NI_PCR, PCR_FREEQNE|PCR_RFREEQ|PCR_OWN);
    406   1.1     ragge 	WAITREG(NI_PCR, PCR_OWN);
    407   1.1     ragge 
    408   1.2     ragge 	splx(s);
    409   1.2     ragge 
    410   1.1     ragge 	/* Set initial parameters */
    411   1.1     ragge 	msg = REMQHI(&fqb->nf_mforw);
    412   1.1     ragge 
    413   1.1     ragge 	msg->nm_opcode = BVP_MSG;
    414   1.1     ragge 	msg->nm_status = 0;
    415   1.1     ragge 	msg->nm_len = sizeof(struct ni_param) + 6;
    416   1.1     ragge 	msg->nm_opcode2 = NI_WPARAM;
    417   1.1     ragge 	((struct ni_param *)&msg->nm_text[0])->np_flags = NP_PAD;
    418   1.1     ragge 
    419   1.2     ragge 	endwait = retry = 0;
    420   1.1     ragge 	res = INSQTI(msg, &gvp->nc_forw0);
    421   1.1     ragge 
    422   1.2     ragge retry:	WAITREG(NI_PCR, PCR_OWN);
    423   1.1     ragge 	NI_WREG(NI_PCR, PCR_CMDQNE|PCR_CMDQ0|PCR_OWN);
    424   1.1     ragge 	WAITREG(NI_PCR, PCR_OWN);
    425   1.2     ragge 	i = 1000;
    426   1.2     ragge 	while (endwait == 0 && --i)
    427   1.2     ragge 		DELAY(10000);
    428   1.2     ragge 
    429   1.2     ragge 	if (endwait == 0) {
    430   1.2     ragge 		if (++retry < 3)
    431   1.2     ragge 			goto retry;
    432   1.2     ragge 		printf("%s: no response to set params\n", sc->sc_dev.dv_xname);
    433   1.2     ragge 		return;
    434   1.2     ragge 	}
    435   1.1     ragge 
    436   1.1     ragge 	/* Clear counters */
    437   1.1     ragge 	msg = REMQHI(&fqb->nf_mforw);
    438   1.1     ragge 	msg->nm_opcode = BVP_MSG;
    439   1.1     ragge 	msg->nm_status = 0;
    440   1.1     ragge 	msg->nm_len = sizeof(struct ni_param) + 6;
    441   1.1     ragge 	msg->nm_opcode2 = NI_RCCNTR;
    442   1.1     ragge 
    443   1.1     ragge 	res = INSQTI(msg, &gvp->nc_forw0);
    444   1.1     ragge 
    445   1.1     ragge 	WAITREG(NI_PCR, PCR_OWN);
    446   1.1     ragge 	NI_WREG(NI_PCR, PCR_CMDQNE|PCR_CMDQ0|PCR_OWN);
    447   1.1     ragge 	WAITREG(NI_PCR, PCR_OWN);
    448   1.1     ragge 
    449   1.1     ragge 	/* Enable transmit logic */
    450   1.1     ragge 	msg = REMQHI(&fqb->nf_mforw);
    451   1.1     ragge 
    452   1.1     ragge 	msg->nm_opcode = BVP_MSG;
    453   1.1     ragge 	msg->nm_status = 0;
    454   1.1     ragge 	msg->nm_len = 18;
    455   1.1     ragge 	msg->nm_opcode2 = NI_STPTDB;
    456   1.1     ragge 	ptdb = (struct ni_ptdb *)&msg->nm_text[0];
    457  1.12   thorpej 	memset(ptdb, 0, sizeof(struct ni_ptdb));
    458   1.1     ragge 	ptdb->np_index = 1;
    459   1.1     ragge 	ptdb->np_fque = 1;
    460   1.1     ragge 
    461   1.1     ragge 	res = INSQTI(msg, &gvp->nc_forw0);
    462   1.1     ragge 
    463   1.1     ragge 	WAITREG(NI_PCR, PCR_OWN);
    464   1.1     ragge 	NI_WREG(NI_PCR, PCR_CMDQNE|PCR_CMDQ0|PCR_OWN);
    465   1.1     ragge 	WAITREG(NI_PCR, PCR_OWN);
    466   1.1     ragge 
    467   1.1     ragge 	/* Wait for everything to finish */
    468   1.1     ragge 	WAITREG(NI_PSR, PSR_OWN);
    469   1.1     ragge 
    470   1.1     ragge 	printf("%s: hardware address %s\n", sc->sc_dev.dv_xname,
    471   1.1     ragge 	    ether_sprintf(sc->sc_enaddr));
    472   1.1     ragge 
    473   1.1     ragge 	/*
    474   1.1     ragge 	 * Attach the interface.
    475   1.1     ragge 	 */
    476   1.1     ragge 	if_attach(ifp);
    477   1.1     ragge 	ether_ifattach(ifp, sc->sc_enaddr);
    478   1.2     ragge 	if (shutdownhook_establish(ni_shutdown, sc) == 0)
    479   1.2     ragge 		printf("%s: WARNING: unable to establish shutdown hook\n",
    480   1.2     ragge 		    sc->sc_dev.dv_xname);
    481   1.1     ragge }
    482   1.1     ragge 
    483   1.1     ragge /*
    484   1.1     ragge  * Initialization of interface.
    485   1.1     ragge  */
    486   1.1     ragge void
    487   1.1     ragge niinit(sc)
    488   1.1     ragge 	struct ni_softc *sc;
    489   1.1     ragge {
    490   1.1     ragge 	struct ifnet *ifp = (struct ifnet *)&sc->sc_if;
    491   1.1     ragge 
    492   1.1     ragge 	/*
    493   1.1     ragge 	 * Set flags (so ni_setup() do the right thing).
    494   1.1     ragge 	 */
    495   1.1     ragge 	ifp->if_flags |= IFF_RUNNING;
    496   1.1     ragge 	ifp->if_flags &= ~IFF_OACTIVE;
    497   1.1     ragge 
    498   1.1     ragge 	/*
    499   1.1     ragge 	 * Send setup messages so that the rx/tx locic starts.
    500   1.1     ragge 	 */
    501   1.1     ragge 	ni_setup(sc);
    502   1.1     ragge 
    503   1.1     ragge }
    504   1.1     ragge 
    505   1.1     ragge /*
    506   1.1     ragge  * Start output on interface.
    507   1.1     ragge  */
    508   1.1     ragge void
    509   1.1     ragge nistart(ifp)
    510   1.1     ragge 	struct ifnet *ifp;
    511   1.1     ragge {
    512   1.1     ragge 	struct ni_softc *sc = ifp->if_softc;
    513   1.1     ragge 	struct ni_dg *data;
    514   1.1     ragge 	struct ni_bbd *bdp;
    515   1.1     ragge 	struct mbuf *m, *m0;
    516   1.1     ragge 	int i, cnt, res, mlen;
    517   1.1     ragge 
    518   1.1     ragge 	if (ifp->if_flags & IFF_OACTIVE)
    519   1.1     ragge 		return;
    520   1.1     ragge #ifdef DEBUG
    521   1.1     ragge 	if (ifp->if_flags & IFF_DEBUG)
    522   1.1     ragge 		printf("%s: nistart\n", sc->sc_dev.dv_xname);
    523   1.1     ragge #endif
    524   1.1     ragge 
    525   1.1     ragge 	while (fqb->nf_dforw) {
    526   1.8   thorpej 		IFQ_POLL(&ifp->if_snd, m);
    527   1.1     ragge 		if (m == 0)
    528   1.1     ragge 			break;
    529   1.1     ragge 
    530   1.1     ragge 		data = REMQHI(&fqb->nf_dforw);
    531   1.1     ragge 		if ((int)data == Q_EMPTY) {
    532   1.1     ragge 			ifp->if_flags |= IFF_OACTIVE;
    533   1.1     ragge 			break;
    534   1.1     ragge 		}
    535   1.8   thorpej 
    536   1.8   thorpej 		IFQ_DEQUEUE(&ifp->if_snd, m);
    537   1.1     ragge 
    538   1.1     ragge 		/*
    539   1.1     ragge 		 * Count number of mbufs in chain.
    540   1.1     ragge 		 * Always do DMA directly from mbufs, therefore the transmit
    541   1.1     ragge 		 * ring is really big.
    542   1.1     ragge 		 */
    543   1.1     ragge 		for (m0 = m, cnt = 0; m0; m0 = m0->m_next)
    544   1.1     ragge 			if (m0->m_len)
    545   1.1     ragge 				cnt++;
    546   1.1     ragge 		if (cnt > NTXFRAGS)
    547   1.1     ragge 			panic("nistart"); /* XXX */
    548   1.1     ragge 
    549   1.1     ragge #if NBPFILTER > 0
    550   1.1     ragge 		if (ifp->if_bpf)
    551   1.1     ragge 			bpf_mtap(ifp->if_bpf, m);
    552   1.1     ragge #endif
    553   1.1     ragge 		bdp = &bbd[(data->bufs[0]._index & 0x7fff)];
    554   1.1     ragge 		for (m0 = m, i = 0, mlen = 0; m0; m0 = m0->m_next) {
    555   1.1     ragge 			if (m0->m_len == 0)
    556   1.1     ragge 				continue;
    557   1.1     ragge 			bdp->nb_status = (mtod(m0, u_int32_t) & NIBD_OFFSET) |
    558   1.1     ragge 			    NIBD_VALID;
    559   1.1     ragge 			bdp->nb_pte = (u_int32_t)kvtopte(mtod(m0, void *));
    560   1.1     ragge 			bdp->nb_len = m0->m_len;
    561  1.19    bouyer 			data->bufs[i]._offset = 0;
    562  1.19    bouyer 			data->bufs[i]._len = bdp->nb_len;
    563  1.19    bouyer 			data->bufs[i]._index |= NIDG_CHAIN;
    564  1.19    bouyer 			mlen += bdp->nb_len;
    565  1.19    bouyer 			bdp++;
    566  1.19    bouyer 			i++;
    567  1.19    bouyer 		}
    568   1.1     ragge 		data->nd_opcode = BVP_DGRAM;
    569   1.1     ragge 		data->nd_pad3 = 1;
    570   1.1     ragge 		data->nd_ptdbidx = 1;
    571   1.1     ragge 		data->nd_len = 10 + i * 8;
    572   1.1     ragge 		data->bufs[i - 1]._index &= ~NIDG_CHAIN;
    573   1.1     ragge 		data->nd_cmdref = (u_int32_t)m;
    574   1.1     ragge #ifdef DEBUG
    575   1.1     ragge 		if (ifp->if_flags & IFF_DEBUG)
    576   1.1     ragge 			printf("%s: sending %d bytes (%d segments)\n",
    577   1.1     ragge 			    sc->sc_dev.dv_xname, mlen, i);
    578   1.1     ragge #endif
    579   1.1     ragge 
    580   1.1     ragge 		res = INSQTI(data, &gvp->nc_forw0);
    581   1.1     ragge 		if (res == Q_EMPTY) {
    582   1.1     ragge 			WAITREG(NI_PCR, PCR_OWN);
    583   1.1     ragge 			NI_WREG(NI_PCR, PCR_CMDQNE|PCR_CMDQ0|PCR_OWN);
    584   1.1     ragge 		}
    585   1.1     ragge 	}
    586   1.1     ragge }
    587   1.1     ragge 
    588   1.1     ragge void
    589   1.1     ragge niintr(void *arg)
    590   1.1     ragge {
    591   1.1     ragge 	struct ni_softc *sc = arg;
    592   1.1     ragge 	struct ni_dg *data;
    593   1.1     ragge 	struct ni_msg *msg;
    594   1.1     ragge 	struct ifnet *ifp = &sc->sc_if;
    595   1.1     ragge 	struct ni_bbd *bd;
    596   1.1     ragge 	struct mbuf *m;
    597   1.1     ragge 	int idx, res;
    598   1.1     ragge 
    599   1.2     ragge 	if ((NI_RREG(NI_PSR) & PSR_STATE) != PSR_ENABLED)
    600   1.2     ragge 		return;
    601   1.2     ragge 
    602   1.2     ragge 	if ((NI_RREG(NI_PSR) & PSR_ERR))
    603   1.2     ragge 		printf("%s: PSR %x\n", sc->sc_dev.dv_xname, NI_RREG(NI_PSR));
    604   1.2     ragge 
    605  1.28        ad 	KERNEL_LOCK(1, NULL);
    606   1.1     ragge 	/* Got any response packets?  */
    607   1.1     ragge 	while ((NI_RREG(NI_PSR) & PSR_RSQ) && (data = REMQHI(&gvp->nc_forwr))) {
    608   1.1     ragge 
    609   1.1     ragge 		switch (data->nd_opcode) {
    610   1.1     ragge 		case BVP_DGRAMRX: /* Receive datagram */
    611   1.1     ragge 			idx = data->bufs[0]._index;
    612   1.1     ragge 			bd = &bbd[idx];
    613   1.1     ragge 			m = (void *)data->nd_cmdref;
    614  1.10     ragge 			m->m_pkthdr.len = m->m_len =
    615  1.10     ragge 			    data->bufs[0]._len - ETHER_CRC_LEN;
    616   1.1     ragge 			m->m_pkthdr.rcvif = ifp;
    617   1.1     ragge 			if (ni_add_rxbuf(sc, data, idx)) {
    618   1.1     ragge 				bd->nb_len = (m->m_ext.ext_size - 2);
    619   1.1     ragge 				bd->nb_pte =
    620   1.1     ragge 				    (long)kvtopte(m->m_ext.ext_buf);
    621   1.1     ragge 				bd->nb_status = 2 | NIBD_VALID;
    622   1.1     ragge 				bd->nb_key = 1;
    623   1.1     ragge 			}
    624   1.1     ragge 			data->nd_len = RXADD;
    625   1.1     ragge 			data->nd_status = 0;
    626   1.1     ragge 			res = INSQTI(data, &fqb->nf_rforw);
    627   1.1     ragge 			if (res == Q_EMPTY) {
    628   1.1     ragge 				WAITREG(NI_PCR, PCR_OWN);
    629   1.1     ragge 				NI_WREG(NI_PCR, PCR_FREEQNE|PCR_RFREEQ|PCR_OWN);
    630   1.1     ragge 			}
    631   1.1     ragge 			if (m == (void *)data->nd_cmdref)
    632   1.1     ragge 				break; /* Out of mbufs */
    633   1.1     ragge 
    634   1.1     ragge #if NBPFILTER > 0
    635   1.6   thorpej 			if (ifp->if_bpf)
    636   1.1     ragge 				bpf_mtap(ifp->if_bpf, m);
    637   1.1     ragge #endif
    638   1.1     ragge 			(*ifp->if_input)(ifp, m);
    639   1.1     ragge 			break;
    640   1.1     ragge 
    641   1.1     ragge 		case BVP_DGRAM:
    642   1.1     ragge 			m = (struct mbuf *)data->nd_cmdref;
    643   1.1     ragge 			ifp->if_flags &= ~IFF_OACTIVE;
    644   1.1     ragge 			m_freem(m);
    645   1.1     ragge 			res = INSQTI(data, &fqb->nf_dforw);
    646   1.1     ragge 			if (res == Q_EMPTY) {
    647   1.1     ragge 				WAITREG(NI_PCR, PCR_OWN);
    648   1.1     ragge 				NI_WREG(NI_PCR, PCR_FREEQNE|PCR_DFREEQ|PCR_OWN);
    649   1.1     ragge 			}
    650   1.1     ragge 			break;
    651   1.1     ragge 
    652   1.1     ragge 		case BVP_MSGRX:
    653   1.1     ragge 			msg = (struct ni_msg *)data;
    654   1.1     ragge 			switch (msg->nm_opcode2) {
    655   1.1     ragge 				case NI_WPARAM:
    656  1.13   thorpej 					memcpy(sc->sc_enaddr, ((struct ni_param *)&msg->nm_text[0])->np_dpa, ETHER_ADDR_LEN);
    657   1.1     ragge 					endwait = 1;
    658   1.1     ragge 					break;
    659   1.1     ragge 
    660   1.1     ragge 				case NI_RCCNTR:
    661   1.1     ragge 				case NI_CLPTDB:
    662   1.1     ragge 				case NI_STPTDB:
    663   1.1     ragge 					break;
    664   1.1     ragge 
    665   1.1     ragge 				default:
    666  1.25     perry 					printf("Unkn resp %d\n",
    667   1.1     ragge 					    msg->nm_opcode2);
    668   1.1     ragge 					break;
    669   1.1     ragge 			}
    670   1.1     ragge 			res = INSQTI(data, &fqb->nf_mforw);
    671   1.1     ragge 			if (res == Q_EMPTY) {
    672   1.1     ragge 				WAITREG(NI_PCR, PCR_OWN);
    673   1.1     ragge 				NI_WREG(NI_PCR, PCR_FREEQNE|PCR_MFREEQ|PCR_OWN);
    674   1.1     ragge 			}
    675   1.1     ragge 			break;
    676   1.1     ragge 
    677   1.1     ragge 		default:
    678   1.1     ragge 			printf("Unknown opcode %d\n", data->nd_opcode);
    679   1.1     ragge 			res = INSQTI(data, &fqb->nf_mforw);
    680   1.1     ragge 			if (res == Q_EMPTY) {
    681   1.1     ragge 				WAITREG(NI_PCR, PCR_OWN);
    682   1.1     ragge 				NI_WREG(NI_PCR, PCR_FREEQNE|PCR_MFREEQ|PCR_OWN);
    683   1.1     ragge 			}
    684   1.1     ragge 		}
    685   1.1     ragge 	}
    686   1.1     ragge 
    687   1.1     ragge 	/* Try to kick on the start routine again */
    688   1.1     ragge 	nistart(ifp);
    689   1.1     ragge 
    690   1.1     ragge 	NI_WREG(NI_PSR, NI_RREG(NI_PSR) & ~(PSR_OWN|PSR_RSQ));
    691  1.28        ad 	KERNEL_UNLOCK_ONE(NULL);
    692   1.1     ragge }
    693   1.1     ragge 
    694   1.1     ragge /*
    695   1.1     ragge  * Process an ioctl request.
    696   1.1     ragge  */
    697   1.1     ragge int
    698   1.1     ragge niioctl(ifp, cmd, data)
    699   1.1     ragge 	register struct ifnet *ifp;
    700   1.1     ragge 	u_long cmd;
    701  1.29  christos 	void *data;
    702   1.1     ragge {
    703   1.1     ragge 	struct ni_softc *sc = ifp->if_softc;
    704   1.1     ragge 	struct ifreq *ifr = (struct ifreq *)data;
    705   1.1     ragge 	struct ifaddr *ifa = (struct ifaddr *)data;
    706   1.1     ragge 	int s = splnet(), error = 0;
    707   1.1     ragge 
    708   1.1     ragge 	switch (cmd) {
    709   1.1     ragge 
    710   1.1     ragge 	case SIOCSIFADDR:
    711   1.1     ragge 		ifp->if_flags |= IFF_UP;
    712   1.1     ragge 		switch(ifa->ifa_addr->sa_family) {
    713   1.1     ragge #ifdef INET
    714   1.1     ragge 		case AF_INET:
    715   1.1     ragge 			niinit(sc);
    716   1.1     ragge 			arp_ifinit(ifp, ifa);
    717   1.1     ragge 			break;
    718   1.1     ragge #endif
    719   1.1     ragge 		}
    720   1.1     ragge 		break;
    721   1.1     ragge 
    722   1.1     ragge 	case SIOCSIFFLAGS:
    723   1.1     ragge 		if ((ifp->if_flags & IFF_UP) == 0 &&
    724   1.1     ragge 		    (ifp->if_flags & IFF_RUNNING) != 0) {
    725   1.1     ragge 			/*
    726   1.1     ragge 			 * If interface is marked down and it is running,
    727   1.1     ragge 			 * stop it.
    728   1.1     ragge 			 */
    729   1.1     ragge 			ifp->if_flags &= ~IFF_RUNNING;
    730   1.1     ragge 			ni_setup(sc);
    731   1.1     ragge 		} else if ((ifp->if_flags & IFF_UP) != 0 &&
    732   1.1     ragge 			   (ifp->if_flags & IFF_RUNNING) == 0) {
    733   1.1     ragge 			/*
    734   1.1     ragge 			 * If interface it marked up and it is stopped, then
    735   1.1     ragge 			 * start it.
    736   1.1     ragge 			 */
    737   1.1     ragge 			niinit(sc);
    738   1.1     ragge 		} else if ((ifp->if_flags & IFF_UP) != 0) {
    739   1.1     ragge 			/*
    740   1.1     ragge 			 * Send a new setup packet to match any new changes.
    741   1.1     ragge 			 * (Like IFF_PROMISC etc)
    742   1.1     ragge 			 */
    743   1.1     ragge 			ni_setup(sc);
    744   1.1     ragge 		}
    745   1.1     ragge 		break;
    746   1.1     ragge 
    747   1.1     ragge 	case SIOCADDMULTI:
    748   1.1     ragge 	case SIOCDELMULTI:
    749   1.1     ragge 		/*
    750   1.1     ragge 		 * Update our multicast list.
    751   1.1     ragge 		 */
    752   1.1     ragge 		error = (cmd == SIOCADDMULTI) ?
    753   1.1     ragge 			ether_addmulti(ifr, &sc->sc_ec):
    754   1.1     ragge 			ether_delmulti(ifr, &sc->sc_ec);
    755   1.1     ragge 
    756   1.1     ragge 		if (error == ENETRESET) {
    757   1.1     ragge 			/*
    758   1.1     ragge 			 * Multicast list has changed; set the hardware filter
    759   1.1     ragge 			 * accordingly.
    760   1.1     ragge 			 */
    761  1.23   thorpej 			if (ifp->if_flags & IFF_RUNNING)
    762  1.23   thorpej 				ni_setup(sc);
    763   1.1     ragge 			error = 0;
    764   1.1     ragge 		}
    765   1.1     ragge 		break;
    766   1.1     ragge 
    767   1.1     ragge 	default:
    768   1.1     ragge 		error = EINVAL;
    769   1.1     ragge 
    770   1.1     ragge 	}
    771   1.1     ragge 	splx(s);
    772   1.1     ragge 	return (error);
    773   1.1     ragge }
    774   1.1     ragge 
    775   1.1     ragge /*
    776   1.1     ragge  * Add a receive buffer to the indicated descriptor.
    777   1.1     ragge  */
    778   1.1     ragge int
    779  1.25     perry ni_add_rxbuf(struct ni_softc *sc, struct ni_dg *data, int idx)
    780   1.1     ragge {
    781   1.1     ragge 	struct ni_bbd *bd = &bbd[idx];
    782   1.1     ragge 	struct mbuf *m;
    783   1.1     ragge 
    784   1.1     ragge 	MGETHDR(m, M_DONTWAIT, MT_DATA);
    785   1.1     ragge 	if (m == NULL)
    786   1.1     ragge 		return (ENOBUFS);
    787   1.1     ragge 
    788   1.1     ragge 	MCLGET(m, M_DONTWAIT);
    789   1.1     ragge 	if ((m->m_flags & M_EXT) == 0) {
    790   1.1     ragge 		m_freem(m);
    791   1.1     ragge 		return (ENOBUFS);
    792   1.1     ragge 	}
    793   1.1     ragge 
    794   1.1     ragge 	m->m_data += 2;
    795   1.1     ragge 	bd->nb_len = (m->m_ext.ext_size - 2);
    796   1.1     ragge 	bd->nb_pte = (long)kvtopte(m->m_ext.ext_buf);
    797   1.1     ragge 	bd->nb_status = 2 | NIBD_VALID;
    798   1.1     ragge 	bd->nb_key = 1;
    799   1.1     ragge 
    800   1.1     ragge 	data->bufs[0]._offset = 0;
    801   1.1     ragge 	data->bufs[0]._len = bd->nb_len;
    802   1.1     ragge 	data->bufs[0]._index = idx;
    803   1.1     ragge 	data->nd_cmdref = (long)m;
    804   1.1     ragge 
    805   1.1     ragge 	return (0);
    806   1.1     ragge }
    807   1.1     ragge 
    808   1.1     ragge /*
    809   1.1     ragge  * Create setup packet and put in queue for sending.
    810   1.1     ragge  */
    811   1.1     ragge void
    812   1.1     ragge ni_setup(struct ni_softc *sc)
    813   1.1     ragge {
    814   1.1     ragge 	struct ifnet *ifp = &sc->sc_if;
    815   1.1     ragge 	struct ni_msg *msg;
    816   1.1     ragge 	struct ni_ptdb *ptdb;
    817   1.1     ragge 	struct ether_multi *enm;
    818   1.1     ragge 	struct ether_multistep step;
    819   1.1     ragge 	int i, res;
    820   1.1     ragge 
    821   1.1     ragge 	msg = REMQHI(&fqb->nf_mforw);
    822   1.1     ragge 	if ((int)msg == Q_EMPTY)
    823   1.1     ragge 		return; /* What to do? */
    824   1.1     ragge 
    825   1.1     ragge 	ptdb = (struct ni_ptdb *)&msg->nm_text[0];
    826  1.12   thorpej 	memset(ptdb, 0, sizeof(struct ni_ptdb));
    827   1.1     ragge 
    828   1.1     ragge 	msg->nm_opcode = BVP_MSG;
    829   1.1     ragge 	msg->nm_len = 18;
    830   1.1     ragge 	ptdb->np_index = 2; /* definition type index */
    831   1.1     ragge 	ptdb->np_fque = 2; /* Free queue */
    832   1.1     ragge 	if (ifp->if_flags & IFF_RUNNING) {
    833   1.1     ragge 		msg->nm_opcode2 = NI_STPTDB;
    834   1.1     ragge 		ptdb->np_type = ETHERTYPE_IP;
    835   1.1     ragge 		ptdb->np_flags = PTDB_UNKN|PTDB_BDC;
    836   1.1     ragge 		if (ifp->if_flags & IFF_PROMISC)
    837   1.1     ragge 			ptdb->np_flags |= PTDB_PROMISC;
    838   1.1     ragge 		memset(ptdb->np_mcast[0], 0xff, ETHER_ADDR_LEN); /* Broadcast */
    839   1.1     ragge 		ptdb->np_adrlen = 1;
    840   1.1     ragge 		msg->nm_len += 8;
    841   1.1     ragge 		ifp->if_flags &= ~IFF_ALLMULTI;
    842   1.1     ragge 		if ((ifp->if_flags & IFF_PROMISC) == 0) {
    843   1.1     ragge 			ETHER_FIRST_MULTI(step, &sc->sc_ec, enm);
    844   1.1     ragge 			i = 1;
    845   1.1     ragge 			while (enm != NULL) {
    846  1.15       wiz 				if (memcmp(enm->enm_addrlo, enm->enm_addrhi, 6)) {
    847   1.1     ragge 					ifp->if_flags |= IFF_ALLMULTI;
    848   1.1     ragge 					ptdb->np_flags |= PTDB_AMC;
    849   1.1     ragge 					break;
    850   1.1     ragge 				}
    851   1.1     ragge 				msg->nm_len += 8;
    852   1.1     ragge 				ptdb->np_adrlen++;
    853  1.13   thorpej 				memcpy(ptdb->np_mcast[i++], enm->enm_addrlo,
    854   1.1     ragge 				    ETHER_ADDR_LEN);
    855   1.1     ragge 				ETHER_NEXT_MULTI(step, enm);
    856   1.1     ragge 			}
    857   1.1     ragge 		}
    858   1.1     ragge 	} else
    859   1.1     ragge 		msg->nm_opcode2 = NI_CLPTDB;
    860   1.1     ragge 
    861   1.1     ragge 	res = INSQTI(msg, &gvp->nc_forw0);
    862   1.1     ragge 	if (res == Q_EMPTY) {
    863   1.1     ragge 		WAITREG(NI_PCR, PCR_OWN);
    864   1.1     ragge 		NI_WREG(NI_PCR, PCR_CMDQNE|PCR_CMDQ0|PCR_OWN);
    865   1.1     ragge 	}
    866   1.1     ragge }
    867   1.1     ragge 
    868   1.1     ragge /*
    869   1.1     ragge  * Check for dead transmit logic. Not uncommon.
    870   1.1     ragge  */
    871   1.1     ragge void
    872   1.1     ragge nitimeout(ifp)
    873   1.1     ragge 	struct ifnet *ifp;
    874   1.1     ragge {
    875   1.1     ragge #if 0
    876   1.1     ragge 	struct ni_softc *sc = ifp->if_softc;
    877   1.1     ragge 
    878   1.1     ragge 	if (sc->sc_inq == 0)
    879   1.1     ragge 		return;
    880   1.1     ragge 
    881   1.1     ragge 	printf("%s: xmit logic died, resetting...\n", sc->sc_dev.dv_xname);
    882   1.1     ragge 	/*
    883   1.1     ragge 	 * Do a reset of interface, to get it going again.
    884   1.1     ragge 	 * Will it work by just restart the transmit logic?
    885   1.1     ragge 	 */
    886   1.1     ragge 	niinit(sc);
    887   1.1     ragge #endif
    888   1.1     ragge }
    889   1.2     ragge 
    890   1.2     ragge /*
    891   1.2     ragge  * Shutdown hook.  Make sure the interface is stopped at reboot.
    892   1.2     ragge  */
    893   1.2     ragge void
    894   1.2     ragge ni_shutdown(arg)
    895   1.2     ragge 	void *arg;
    896   1.2     ragge {
    897   1.2     ragge 	struct ni_softc *sc = arg;
    898   1.2     ragge 
    899   1.2     ragge         WAITREG(NI_PCR, PCR_OWN);
    900   1.2     ragge         NI_WREG(NI_PCR, PCR_OWN|PCR_SHUTDOWN);
    901   1.2     ragge         WAITREG(NI_PCR, PCR_OWN);
    902   1.2     ragge         WAITREG(NI_PSR, PSR_OWN);
    903   1.2     ragge 
    904   1.2     ragge }
    905   1.2     ragge 
    906