Home | History | Annotate | Line # | Download | only in nubus
if_netdock_nubus.c revision 1.4
      1  1.4    lukem /*	$NetBSD: if_netdock_nubus.c,v 1.4 2003/07/15 02:43:23 lukem Exp $	*/
      2  1.1   itojun 
      3  1.1   itojun /*
      4  1.1   itojun  * Copyright (C) 2000,2002 Daishi Kato <daishi (at) axlight.com>
      5  1.1   itojun  * All rights reserved.
      6  1.1   itojun  *
      7  1.1   itojun  * Redistribution and use in source and binary forms, with or without
      8  1.1   itojun  * modification, are permitted provided that the following conditions
      9  1.1   itojun  * are met:
     10  1.1   itojun  * 1. Redistributions of source code must retain the above copyright
     11  1.1   itojun  *    notice, this list of conditions and the following disclaimer.
     12  1.1   itojun  * 2. Redistributions in binary form must reproduce the above copyright
     13  1.1   itojun  *    notice, this list of conditions and the following disclaimer in the
     14  1.1   itojun  *    documentation and/or other materials provided with the distribution.
     15  1.1   itojun  * 3. All advertising materials mentioning features or use of this software
     16  1.1   itojun  *    must display the following acknowledgement:
     17  1.1   itojun  *      This product includes software developed by Daishi Kato
     18  1.1   itojun  * 4. The name of the author may not be used to endorse or promote products
     19  1.1   itojun  *    derived from this software without specific prior written permission.
     20  1.1   itojun  *
     21  1.1   itojun  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
     22  1.1   itojun  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
     23  1.1   itojun  * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
     24  1.1   itojun  * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
     25  1.1   itojun  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
     26  1.1   itojun  * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
     27  1.1   itojun  * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
     28  1.1   itojun  * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
     29  1.1   itojun  * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
     30  1.1   itojun  * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
     31  1.1   itojun  */
     32  1.1   itojun 
     33  1.1   itojun /*
     34  1.1   itojun  * Asante NetDock (for Duo series) driver
     35  1.1   itojun  * the chip inside is not known
     36  1.1   itojun  */
     37  1.1   itojun 
     38  1.1   itojun /*
     39  1.1   itojun  * The author would like to thank Takeo Kuwata <tkuwata (at) mac.com> for
     40  1.1   itojun  * his help in stabilizing this driver.
     41  1.1   itojun  */
     42  1.1   itojun 
     43  1.1   itojun /***********************/
     44  1.4    lukem 
     45  1.4    lukem #include <sys/cdefs.h>
     46  1.4    lukem __KERNEL_RCSID(0, "$NetBSD: if_netdock_nubus.c,v 1.4 2003/07/15 02:43:23 lukem Exp $");
     47  1.1   itojun 
     48  1.1   itojun #include <sys/param.h>
     49  1.1   itojun #include <sys/device.h>
     50  1.1   itojun #include <sys/socket.h>
     51  1.1   itojun #include <sys/systm.h>
     52  1.1   itojun #include <sys/mbuf.h>
     53  1.1   itojun #include <sys/ioctl.h>
     54  1.1   itojun 
     55  1.1   itojun #include <net/if.h>
     56  1.1   itojun #include <net/if_dl.h>
     57  1.1   itojun #include <net/if_ether.h>
     58  1.1   itojun 
     59  1.1   itojun #include "opt_inet.h"
     60  1.1   itojun #ifdef INET
     61  1.1   itojun #include <netinet/in.h>
     62  1.1   itojun #include <netinet/if_inarp.h>
     63  1.1   itojun #endif
     64  1.1   itojun 
     65  1.1   itojun #include "bpfilter.h"
     66  1.1   itojun #if NBPFILTER > 0
     67  1.1   itojun #include <net/bpf.h>
     68  1.1   itojun #endif
     69  1.1   itojun 
     70  1.1   itojun #include <machine/bus.h>
     71  1.1   itojun #include <machine/viareg.h>
     72  1.1   itojun #include <mac68k/nubus/nubus.h>
     73  1.1   itojun 
     74  1.1   itojun /***********************/
     75  1.1   itojun 
     76  1.1   itojun #define NETDOCK_DEBUG
     77  1.1   itojun 
     78  1.1   itojun #define NETDOCK_NUBUS_CATEGORY	0x0020
     79  1.1   itojun #define NETDOCK_NUBUS_TYPE	0x0003
     80  1.1   itojun #define NETDOCK_NUBUS_DRSW	0x0103
     81  1.1   itojun #define NETDOCK_NUBUS_DRHW	0x0100
     82  1.1   itojun 
     83  1.1   itojun #define ETHERMICRODOCK_NUBUS_CATEGORY	0x0020
     84  1.1   itojun #define ETHERMICRODOCK_NUBUS_TYPE	0x0003
     85  1.1   itojun #define ETHERMICRODOCK_NUBUS_DRSW	0x0102
     86  1.1   itojun #define ETHERMICRODOCK_NUBUS_DRHW	0x0100
     87  1.1   itojun 
     88  1.1   itojun #define REG_ISR		0x000c
     89  1.1   itojun #define REG_000E	0x000e
     90  1.1   itojun #define REG_0000	0x0000
     91  1.1   itojun #define REG_0002	0x0002
     92  1.1   itojun #define REG_0004	0x0004
     93  1.1   itojun #define REG_0006	0x0006
     94  1.1   itojun #define REG_DATA	0x0008
     95  1.1   itojun #define REG_EFD00	0xefd00
     96  1.1   itojun 
     97  1.1   itojun #define ISR_ALL		0x3300
     98  1.1   itojun #define ISR_TX		0x0200
     99  1.1   itojun #define ISR_RX		0x0100
    100  1.1   itojun #define ISR_READY	0x0800
    101  1.1   itojun #define ISR_BIT_0C	0x1000
    102  1.1   itojun #define ISR_BIT_0D	0x2000
    103  1.1   itojun #define ISR_MASK	0x0033
    104  1.1   itojun #define ISR_BIT_03	0x0008
    105  1.1   itojun 
    106  1.1   itojun #define REG_0002_BIT_04	0x0010
    107  1.1   itojun #define REG_0000_BIT_08	0x0100
    108  1.1   itojun #define REG_0004_BIT_0F	0x8000
    109  1.1   itojun #define REG_0004_BIT_07 0x0080
    110  1.1   itojun #define REG_DATA_BIT_02 0x0004
    111  1.1   itojun #define REG_DATA_BIT_03 0x0008
    112  1.1   itojun #define REG_DATA_BIT_04 0x0010
    113  1.1   itojun #define REG_DATA_BIT_05 0x0020
    114  1.1   itojun #define REG_DATA_BIT_08	0x0100
    115  1.1   itojun #define REG_DATA_BIT_07	0x0080
    116  1.1   itojun #define REG_DATA_BIT_0F	0x8000
    117  1.1   itojun 
    118  1.1   itojun /***********************/
    119  1.1   itojun 
    120  1.1   itojun typedef struct netdock_softc {
    121  1.1   itojun 	struct device	sc_dev;
    122  1.1   itojun 	struct ethercom	sc_ethercom;
    123  1.1   itojun #define sc_if		sc_ethercom.ec_if
    124  1.1   itojun 
    125  1.1   itojun 	bus_space_tag_t		sc_regt;
    126  1.1   itojun 	bus_space_handle_t	sc_regh;
    127  1.1   itojun 
    128  1.1   itojun 	u_int8_t	sc_enaddr[ETHER_ADDR_LEN];
    129  1.1   itojun 
    130  1.1   itojun } netdock_softc_t;
    131  1.1   itojun 
    132  1.1   itojun /***********************/
    133  1.1   itojun 
    134  1.1   itojun static int	netdock_nubus_match __P((struct device *, struct cfdata *,
    135  1.1   itojun 			void*));
    136  1.1   itojun static void	netdock_nubus_attach __P((struct device *, struct device *,
    137  1.1   itojun 			void *));
    138  1.1   itojun static int	netdock_nb_get_enaddr __P((bus_space_tag_t, bus_space_handle_t,
    139  1.1   itojun 			struct nubus_attach_args *, u_int8_t  *));
    140  1.1   itojun #ifdef NETDOCK_DEBUG_DRIVER
    141  1.1   itojun static void	netdock_print_driver __P((bus_space_tag_t, bus_space_handle_t,
    142  1.1   itojun 			struct nubus_attach_args *));
    143  1.1   itojun #endif
    144  1.1   itojun 
    145  1.1   itojun int	netdock_setup __P((struct netdock_softc *, u_int8_t *));
    146  1.1   itojun void	netdock_intr __P((void *));
    147  1.1   itojun 
    148  1.1   itojun static void	netdock_watchdog __P((struct ifnet *));
    149  1.1   itojun static int	netdock_init __P((struct netdock_softc *));
    150  1.1   itojun static int	netdock_stop __P((struct netdock_softc *));
    151  1.1   itojun static int	netdock_ioctl __P((struct ifnet *, u_long, caddr_t));
    152  1.1   itojun static void	netdock_start __P((struct ifnet *));
    153  1.1   itojun static void	netdock_reset __P((struct netdock_softc *));
    154  1.1   itojun static void	netdock_txint __P((struct netdock_softc *));
    155  1.1   itojun static void	netdock_rxint __P((struct netdock_softc *));
    156  1.1   itojun 
    157  1.1   itojun static u_int	netdock_put __P((struct netdock_softc *, struct mbuf *));
    158  1.1   itojun static int	netdock_read __P((struct netdock_softc *, int));
    159  1.1   itojun static struct mbuf *netdock_get __P((struct netdock_softc *, int));
    160  1.1   itojun 
    161  1.1   itojun /***********************/
    162  1.1   itojun 
    163  1.1   itojun #define NIC_GET_1(sc, o)	(bus_space_read_1((sc)->sc_regt,	\
    164  1.1   itojun 					(sc)->sc_regh, (o)))
    165  1.1   itojun #define NIC_PUT_1(sc, o, val)	(bus_space_write_1((sc)->sc_regt,	\
    166  1.1   itojun 					(sc)->sc_regh, (o), (val)))
    167  1.1   itojun #define NIC_GET_2(sc, o)	(bus_space_read_2((sc)->sc_regt,	\
    168  1.1   itojun 					(sc)->sc_regh, (o)))
    169  1.1   itojun #define NIC_PUT_2(sc, o, val)	(bus_space_write_2((sc)->sc_regt,	\
    170  1.1   itojun 					(sc)->sc_regh, (o), (val)))
    171  1.1   itojun #define NIC_GET_4(sc, o)	(bus_space_read_4((sc)->sc_regt,	\
    172  1.1   itojun 					(sc)->sc_regh, (o)))
    173  1.1   itojun #define NIC_PUT_4(sc, o, val)	(bus_space_write_4((sc)->sc_regt,	\
    174  1.1   itojun 					(sc)->sc_regh, (o), (val)))
    175  1.1   itojun 
    176  1.1   itojun #define NIC_BSET(sc, o, b)						\
    177  1.1   itojun 	__asm__ __volatile("bset %0,%1" : : "di" ((u_short)(b)),	\
    178  1.1   itojun 		"g" (*(u_int8_t *)((sc)->sc_regh.base + (o))))
    179  1.1   itojun #define NIC_BCLR(sc, o, b)						\
    180  1.1   itojun 	__asm__ __volatile("bclr %0,%1" : : "di" ((u_short)(b)),	\
    181  1.1   itojun 		"g" (*(u_int8_t *)((sc)->sc_regh.base + (o))))
    182  1.1   itojun #define NIC_ANDW(sc, o, b)						\
    183  1.1   itojun 	__asm__ __volatile("andw %0,%1" : : "di" ((u_short)(b)),	\
    184  1.1   itojun 		"g" (*(u_int8_t *)((sc)->sc_regh.base + (o))))
    185  1.1   itojun #define NIC_ORW(sc, o, b)						\
    186  1.1   itojun 	__asm__ __volatile("orw %0,%1" : : "di" ((u_short)(b)),	\
    187  1.1   itojun 		"g" (*(u_int8_t *)((sc)->sc_regh.base + (o))))
    188  1.1   itojun 
    189  1.1   itojun 
    190  1.1   itojun /***********************/
    191  1.1   itojun 
    192  1.3  thorpej CFATTACH_DECL(netdock_nubus, sizeof(struct netdock_softc),
    193  1.3  thorpej     netdock_nubus_match, netdock_nubus_attach, NULL, NULL);
    194  1.1   itojun 
    195  1.1   itojun /***********************/
    196  1.1   itojun 
    197  1.1   itojun static int
    198  1.1   itojun netdock_nubus_match(parent, cf, aux)
    199  1.1   itojun 	struct device *parent;
    200  1.1   itojun 	struct cfdata *cf;
    201  1.1   itojun 	void *aux;
    202  1.1   itojun {
    203  1.1   itojun 	struct nubus_attach_args *na = (struct nubus_attach_args *)aux;
    204  1.1   itojun 	bus_space_handle_t bsh;
    205  1.1   itojun 	int rv;
    206  1.1   itojun 
    207  1.1   itojun 	if (bus_space_map(na->na_tag, NUBUS_SLOT2PA(na->slot),
    208  1.1   itojun 	    NBMEMSIZE, 0, &bsh))
    209  1.1   itojun 		return (0);
    210  1.1   itojun 
    211  1.1   itojun 	rv = 0;
    212  1.1   itojun 
    213  1.1   itojun 	if (na->category == NETDOCK_NUBUS_CATEGORY &&
    214  1.1   itojun 	    na->type == NETDOCK_NUBUS_TYPE &&
    215  1.1   itojun 	    na->drsw == NETDOCK_NUBUS_DRSW) {
    216  1.1   itojun 		/* assuming this IS Asante NetDock */
    217  1.1   itojun 		rv = 1;
    218  1.1   itojun 	}
    219  1.1   itojun 
    220  1.1   itojun 	if (na->category == ETHERMICRODOCK_NUBUS_CATEGORY &&
    221  1.1   itojun 	    na->type == ETHERMICRODOCK_NUBUS_TYPE &&
    222  1.1   itojun 	    na->drsw == ETHERMICRODOCK_NUBUS_DRSW) {
    223  1.1   itojun 		/* assuming this IS Newer EtherMicroDock */
    224  1.1   itojun 		rv = 1;
    225  1.1   itojun 	}
    226  1.1   itojun 
    227  1.1   itojun 	bus_space_unmap(na->na_tag, bsh, NBMEMSIZE);
    228  1.1   itojun 
    229  1.1   itojun 	return rv;
    230  1.1   itojun }
    231  1.1   itojun 
    232  1.1   itojun static void
    233  1.1   itojun netdock_nubus_attach(parent, self, aux)
    234  1.1   itojun 	struct device *parent, *self;
    235  1.1   itojun 	void *aux;
    236  1.1   itojun {
    237  1.1   itojun 	struct netdock_softc *sc = (struct netdock_softc *)self;
    238  1.1   itojun 	struct nubus_attach_args *na = (struct nubus_attach_args *)aux;
    239  1.1   itojun 	bus_space_tag_t bst;
    240  1.1   itojun 	bus_space_handle_t bsh;
    241  1.1   itojun 	u_int8_t enaddr[ETHER_ADDR_LEN];
    242  1.1   itojun 	char *cardtype;
    243  1.1   itojun 
    244  1.1   itojun 	bst = na->na_tag;
    245  1.1   itojun 	if (bus_space_map(bst, NUBUS_SLOT2PA(na->slot), NBMEMSIZE, 0, &bsh)) {
    246  1.1   itojun 		printf(": failed to map memory space.\n");
    247  1.1   itojun 		return;
    248  1.1   itojun 	}
    249  1.1   itojun 
    250  1.1   itojun 	sc->sc_regt = bst;
    251  1.1   itojun 	cardtype = nubus_get_card_name(bst, bsh, na->fmt);
    252  1.1   itojun 
    253  1.1   itojun #ifdef NETDOCK_DEBUG_DRIVER
    254  1.1   itojun 	netdock_print_driver(bst, bsh, na);
    255  1.1   itojun #endif
    256  1.1   itojun 
    257  1.1   itojun 	if (netdock_nb_get_enaddr(bst, bsh, na, enaddr)) {
    258  1.1   itojun 		printf(": can't find MAC address.\n");
    259  1.1   itojun 		bus_space_unmap(bst, bsh, NBMEMSIZE);
    260  1.1   itojun 		return;
    261  1.1   itojun 	}
    262  1.1   itojun 
    263  1.1   itojun 	if (bus_space_subregion(bst, bsh, 0xe00300, 0xf0000, &sc->sc_regh)) {
    264  1.1   itojun 		printf(": failed to map register space.\n");
    265  1.1   itojun 		bus_space_unmap(bst, bsh, NBMEMSIZE);
    266  1.1   itojun 		return;
    267  1.1   itojun 	}
    268  1.1   itojun 
    269  1.1   itojun 	printf(": %s\n", cardtype);
    270  1.1   itojun 
    271  1.1   itojun 	if (netdock_setup(sc, enaddr)) {
    272  1.1   itojun 		bus_space_unmap(bst, bsh, NBMEMSIZE);
    273  1.1   itojun 		return;
    274  1.1   itojun 	}
    275  1.1   itojun 
    276  1.1   itojun 	add_nubus_intr(na->slot, netdock_intr, (void *)sc);
    277  1.1   itojun 
    278  1.1   itojun 	return;
    279  1.1   itojun }
    280  1.1   itojun 
    281  1.1   itojun static int
    282  1.1   itojun netdock_nb_get_enaddr(bst, bsh, na, ep)
    283  1.1   itojun 	bus_space_tag_t bst;
    284  1.1   itojun 	bus_space_handle_t bsh;
    285  1.1   itojun 	struct nubus_attach_args *na;
    286  1.1   itojun 	u_int8_t *ep;
    287  1.1   itojun {
    288  1.1   itojun 	nubus_dir dir;
    289  1.1   itojun 	nubus_dirent dirent;
    290  1.1   itojun 
    291  1.1   itojun 	/*
    292  1.1   itojun 	 * these hardwired resource IDs are only for NetDock
    293  1.1   itojun 	 */
    294  1.1   itojun 	nubus_get_main_dir(na->fmt, &dir);
    295  1.1   itojun 	if (nubus_find_rsrc(bst, bsh, na->fmt, &dir, 0x81, &dirent) <= 0)
    296  1.1   itojun 		return 1;
    297  1.1   itojun 	nubus_get_dir_from_rsrc(na->fmt, &dirent, &dir);
    298  1.1   itojun 	if (nubus_find_rsrc(bst, bsh, na->fmt, &dir, 0x80, &dirent) <= 0)
    299  1.1   itojun 		return 1;
    300  1.1   itojun 	if (nubus_get_ind_data(bst, bsh, na->fmt, &dirent,
    301  1.1   itojun 		ep, ETHER_ADDR_LEN) <= 0)
    302  1.1   itojun 		return 1;
    303  1.1   itojun 
    304  1.1   itojun 	return 0;
    305  1.1   itojun }
    306  1.1   itojun 
    307  1.1   itojun #ifdef NETDOCK_DEBUG_DRIVER
    308  1.1   itojun static void
    309  1.1   itojun netdock_print_driver(bst, bsh, na)
    310  1.1   itojun 	bus_space_tag_t bst;
    311  1.1   itojun 	bus_space_handle_t bsh;
    312  1.1   itojun 	struct nubus_attach_args *na;
    313  1.1   itojun {
    314  1.1   itojun #define HEADSIZE	(8+4)
    315  1.1   itojun #define CODESIZE	(6759-4)
    316  1.1   itojun 	unsigned char mydata[HEADSIZE + CODESIZE];
    317  1.1   itojun 	nubus_dir dir;
    318  1.1   itojun 	nubus_dirent dirent;
    319  1.1   itojun 	int i, rv;
    320  1.1   itojun 
    321  1.1   itojun 	nubus_get_main_dir(na->fmt, &dir);
    322  1.1   itojun 	rv = nubus_find_rsrc(bst, bsh, na->fmt, &dir, 0x81, &dirent);
    323  1.1   itojun 	if (rv <= 0) {
    324  1.1   itojun 		printf(": can't find sResource.\n");
    325  1.1   itojun 		return;
    326  1.1   itojun 	}
    327  1.1   itojun 	nubus_get_dir_from_rsrc(na->fmt, &dirent, &dir);
    328  1.1   itojun 	if (nubus_find_rsrc(bst, bsh, na->fmt, &dir, NUBUS_RSRC_DRVRDIR,
    329  1.1   itojun 	    &dirent) <= 0) {
    330  1.1   itojun 		printf(": can't find sResource.\n");
    331  1.1   itojun 		return;
    332  1.1   itojun 	}
    333  1.1   itojun 	if (nubus_get_ind_data(bst, bsh, na->fmt,
    334  1.1   itojun 		&dirent, mydata, HEADSIZE+CODESIZE) <= 0) {
    335  1.1   itojun 		printf(": can't find indirect data.\n");
    336  1.1   itojun 		return;
    337  1.1   itojun 	}
    338  1.1   itojun 	printf("\n########## begin driver dir");
    339  1.1   itojun 	for (i = 0; i < HEADSIZE; i++) {
    340  1.1   itojun 		if (i % 16 == 0)
    341  1.1   itojun 			printf("\n%02x:",i);
    342  1.1   itojun 		printf(" %02x", mydata[i]);
    343  1.1   itojun 	}
    344  1.1   itojun 	printf("\n########## begin driver code");
    345  1.1   itojun 	for (i = 0; i < CODESIZE; i++) {
    346  1.1   itojun 		if (i % 16 == 0)
    347  1.1   itojun 			printf("\n%02x:",i);
    348  1.1   itojun 		printf(" %02x", mydata[i + HEADSIZE]);
    349  1.1   itojun 	}
    350  1.1   itojun #if 0
    351  1.1   itojun 	printf("\n########## begin driver code (partial)\n");
    352  1.1   itojun #define PARTSIZE 256
    353  1.1   itojun #define OFFSET 0x1568
    354  1.1   itojun 	for (i = OFFSET; i < OFFSET + PARTSIZE; i++) {
    355  1.1   itojun 		if ((i - OFFSET) % 16 == 0)
    356  1.1   itojun 			printf("\n%02x:",i);
    357  1.1   itojun 		printf(" %02x", mydata[i + HEADSIZE]);
    358  1.1   itojun 	}
    359  1.1   itojun #endif
    360  1.1   itojun 	printf("\n########## end\n");
    361  1.1   itojun }
    362  1.1   itojun #endif
    363  1.1   itojun 
    364  1.1   itojun 
    365  1.1   itojun int
    366  1.1   itojun netdock_setup(sc, lladdr)
    367  1.1   itojun 	struct netdock_softc *sc;
    368  1.1   itojun 	u_int8_t *lladdr;
    369  1.1   itojun {
    370  1.1   itojun 	struct ifnet *ifp = &sc->sc_if;
    371  1.1   itojun 
    372  1.1   itojun 	bcopy(lladdr, sc->sc_enaddr, ETHER_ADDR_LEN);
    373  1.1   itojun 	printf("%s: Ethernet address %s\n",
    374  1.1   itojun 	    sc->sc_dev.dv_xname, ether_sprintf(lladdr));
    375  1.1   itojun 
    376  1.1   itojun 	bcopy(sc->sc_dev.dv_xname, ifp->if_xname, IFNAMSIZ);
    377  1.1   itojun 	ifp->if_softc = sc;
    378  1.1   itojun 	ifp->if_ioctl = netdock_ioctl;
    379  1.1   itojun 	ifp->if_start = netdock_start;
    380  1.1   itojun 	ifp->if_flags =
    381  1.1   itojun 	    IFF_BROADCAST | IFF_SIMPLEX | IFF_NOTRAILERS | IFF_MULTICAST;
    382  1.1   itojun 	ifp->if_watchdog = netdock_watchdog;
    383  1.1   itojun 
    384  1.1   itojun 	if_attach(ifp);
    385  1.1   itojun 	ether_ifattach(ifp, lladdr);
    386  1.1   itojun 
    387  1.1   itojun 	return (0);
    388  1.1   itojun }
    389  1.1   itojun 
    390  1.1   itojun static int
    391  1.1   itojun netdock_ioctl(ifp, cmd, data)
    392  1.1   itojun 	struct ifnet *ifp;
    393  1.1   itojun 	u_long cmd;
    394  1.1   itojun 	caddr_t data;
    395  1.1   itojun {
    396  1.1   itojun 	struct ifaddr *ifa;
    397  1.1   itojun 	struct ifreq *ifr;
    398  1.1   itojun 	struct netdock_softc *sc = ifp->if_softc;
    399  1.1   itojun 	int s = splnet();
    400  1.1   itojun 	int err = 0;
    401  1.1   itojun 	int temp;
    402  1.1   itojun 
    403  1.1   itojun 	switch (cmd) {
    404  1.1   itojun 	case SIOCSIFADDR:
    405  1.1   itojun 		ifa = (struct ifaddr *)data;
    406  1.1   itojun 		ifp->if_flags |= IFF_UP;
    407  1.1   itojun 		switch (ifa->ifa_addr->sa_family) {
    408  1.1   itojun #ifdef INET
    409  1.1   itojun 		case AF_INET:
    410  1.1   itojun 			(void)netdock_init(sc);
    411  1.1   itojun 			arp_ifinit(ifp, ifa);
    412  1.1   itojun 			break;
    413  1.1   itojun #endif
    414  1.1   itojun 		default:
    415  1.1   itojun 			(void)netdock_init(sc);
    416  1.1   itojun 			break;
    417  1.1   itojun 		}
    418  1.1   itojun 		break;
    419  1.1   itojun 
    420  1.1   itojun 	case SIOCSIFFLAGS:
    421  1.1   itojun 		if ((ifp->if_flags & IFF_UP) == 0 &&
    422  1.1   itojun 		    (ifp->if_flags & IFF_RUNNING) != 0) {
    423  1.1   itojun 			netdock_stop(sc);
    424  1.1   itojun 			ifp->if_flags &= ~IFF_RUNNING;
    425  1.1   itojun 		} else if ((ifp->if_flags & IFF_UP) != 0 &&
    426  1.1   itojun 		    (ifp->if_flags & IFF_RUNNING) == 0) {
    427  1.1   itojun 			(void)netdock_init(sc);
    428  1.1   itojun 		} else {
    429  1.1   itojun 			temp = ifp->if_flags & IFF_UP;
    430  1.1   itojun 			netdock_reset(sc);
    431  1.1   itojun 			ifp->if_flags |= temp;
    432  1.1   itojun 			netdock_start(ifp);
    433  1.1   itojun 		}
    434  1.1   itojun 		break;
    435  1.1   itojun 
    436  1.1   itojun 	case SIOCADDMULTI:
    437  1.1   itojun 	case SIOCDELMULTI:
    438  1.1   itojun 		ifr = (struct ifreq *)data;
    439  1.1   itojun 		if (cmd == SIOCADDMULTI)
    440  1.1   itojun 			err = ether_addmulti(ifr, &sc->sc_ethercom);
    441  1.1   itojun 		else
    442  1.1   itojun 			err = ether_delmulti(ifr, &sc->sc_ethercom);
    443  1.1   itojun 
    444  1.1   itojun 		if (err == ENETRESET) {
    445  1.1   itojun 			temp = ifp->if_flags & IFF_UP;
    446  1.1   itojun 			netdock_reset(sc);
    447  1.1   itojun 			ifp->if_flags |= temp;
    448  1.1   itojun 			err = 0;
    449  1.1   itojun 		}
    450  1.1   itojun 		break;
    451  1.1   itojun 	default:
    452  1.1   itojun 		err = EINVAL;
    453  1.1   itojun 		break;
    454  1.1   itojun 	}
    455  1.1   itojun 	splx(s);
    456  1.1   itojun 	return (err);
    457  1.1   itojun }
    458  1.1   itojun 
    459  1.1   itojun static void
    460  1.1   itojun netdock_start(ifp)
    461  1.1   itojun 	struct ifnet *ifp;
    462  1.1   itojun {
    463  1.1   itojun 	struct netdock_softc *sc = ifp->if_softc;
    464  1.1   itojun 	struct mbuf *m;
    465  1.1   itojun 
    466  1.1   itojun 	if ((ifp->if_flags & (IFF_RUNNING | IFF_OACTIVE)) != IFF_RUNNING)
    467  1.1   itojun 		return;
    468  1.1   itojun 
    469  1.1   itojun 	while (1) {
    470  1.1   itojun 		IF_DEQUEUE(&ifp->if_snd, m);
    471  1.1   itojun 		if (m == 0)
    472  1.1   itojun 			return;
    473  1.1   itojun 
    474  1.1   itojun 		if ((m->m_flags & M_PKTHDR) == 0)
    475  1.1   itojun 			panic("%s: netdock_start: no header mbuf",
    476  1.1   itojun 				sc->sc_dev.dv_xname);
    477  1.1   itojun 
    478  1.1   itojun #if NBPFILTER > 0
    479  1.1   itojun 		if (ifp->if_bpf)
    480  1.1   itojun 			bpf_mtap(ifp->if_bpf, m);
    481  1.1   itojun #endif
    482  1.1   itojun 
    483  1.1   itojun 		if ((netdock_put(sc, m)) == 0) {
    484  1.1   itojun 			IF_PREPEND(&ifp->if_snd, m);
    485  1.1   itojun 			return;
    486  1.1   itojun 		}
    487  1.1   itojun 
    488  1.1   itojun 		ifp->if_opackets++;
    489  1.1   itojun 	}
    490  1.1   itojun 
    491  1.1   itojun }
    492  1.1   itojun 
    493  1.1   itojun static void
    494  1.1   itojun netdock_reset(sc)
    495  1.1   itojun 	struct netdock_softc *sc;
    496  1.1   itojun {
    497  1.1   itojun 
    498  1.1   itojun 	netdock_stop(sc);
    499  1.1   itojun 	netdock_init(sc);
    500  1.1   itojun }
    501  1.1   itojun 
    502  1.1   itojun static int
    503  1.1   itojun netdock_init(sc)
    504  1.1   itojun 	struct netdock_softc *sc;
    505  1.1   itojun {
    506  1.1   itojun 	int s;
    507  1.1   itojun 	int saveisr;
    508  1.1   itojun 	int savetmp;
    509  1.1   itojun 
    510  1.1   itojun 	if (sc->sc_if.if_flags & IFF_RUNNING)
    511  1.1   itojun 		return (0);
    512  1.1   itojun 
    513  1.1   itojun 	s = splnet();
    514  1.1   itojun 
    515  1.1   itojun 	/* 0606 */
    516  1.1   itojun 	NIC_PUT_2(sc, REG_000E, 0x0200);
    517  1.1   itojun 	NIC_PUT_2(sc, REG_ISR , 0);
    518  1.1   itojun 	NIC_PUT_2(sc, REG_000E, 0);
    519  1.1   itojun 
    520  1.1   itojun 	NIC_PUT_2(sc, REG_0000, 0x8104);
    521  1.1   itojun 	NIC_PUT_2(sc, REG_0004, 0x0043);
    522  1.1   itojun 	NIC_PUT_2(sc, REG_000E, 0x0100);
    523  1.1   itojun 	NIC_PUT_2(sc, REG_0002, 0x6618);
    524  1.1   itojun 	NIC_PUT_2(sc, REG_0000, 0x8010);
    525  1.1   itojun 
    526  1.1   itojun 	NIC_PUT_1(sc, REG_0004 + 0, sc->sc_enaddr[0]);
    527  1.1   itojun 	NIC_PUT_1(sc, REG_0004 + 1, sc->sc_enaddr[1]);
    528  1.1   itojun 	NIC_PUT_1(sc, REG_0004 + 2, sc->sc_enaddr[2]);
    529  1.1   itojun 	NIC_PUT_1(sc, REG_0004 + 3, sc->sc_enaddr[3]);
    530  1.1   itojun 	NIC_PUT_1(sc, REG_0004 + 4, sc->sc_enaddr[4]);
    531  1.1   itojun 	NIC_PUT_1(sc, REG_0004 + 5, sc->sc_enaddr[5]);
    532  1.1   itojun 
    533  1.1   itojun 	NIC_PUT_2(sc, REG_ISR , 0x2008);
    534  1.1   itojun 	NIC_PUT_2(sc, REG_000E, 0x0200);
    535  1.1   itojun 	NIC_PUT_2(sc, REG_0000, 0x4000);
    536  1.1   itojun 	NIC_PUT_2(sc, REG_ISR, ISR_MASK);
    537  1.1   itojun 
    538  1.1   itojun 
    539  1.1   itojun 	/* 1320 */
    540  1.1   itojun 	saveisr = NIC_GET_2(sc, REG_ISR);
    541  1.1   itojun 	NIC_PUT_2(sc, REG_ISR , 0);
    542  1.1   itojun 	savetmp = NIC_GET_2(sc, REG_000E);
    543  1.1   itojun 	NIC_PUT_2(sc, REG_000E, 0x0100);
    544  1.1   itojun 	NIC_ANDW(sc, REG_ISR, ~ISR_BIT_03);
    545  1.1   itojun 	NIC_PUT_2(sc, REG_000E, savetmp);
    546  1.1   itojun 
    547  1.1   itojun 	/* 1382 */
    548  1.1   itojun 	savetmp = NIC_GET_2(sc, REG_000E);
    549  1.1   itojun 	NIC_PUT_2(sc, REG_000E, 0x0100);
    550  1.1   itojun 	NIC_ORW(sc, REG_ISR, ISR_BIT_03);
    551  1.1   itojun 	NIC_PUT_2(sc, REG_000E, savetmp);
    552  1.1   itojun 	NIC_PUT_2(sc, REG_ISR , saveisr);
    553  1.1   itojun 
    554  1.1   itojun 
    555  1.1   itojun 	sc->sc_if.if_flags |= IFF_RUNNING;
    556  1.1   itojun 	sc->sc_if.if_flags &= ~IFF_OACTIVE;
    557  1.1   itojun 
    558  1.1   itojun 	splx(s);
    559  1.1   itojun 	return (0);
    560  1.1   itojun }
    561  1.1   itojun 
    562  1.1   itojun static int
    563  1.1   itojun netdock_stop(sc)
    564  1.1   itojun 	struct netdock_softc *sc;
    565  1.1   itojun {
    566  1.1   itojun 	int s = splnet();
    567  1.1   itojun 
    568  1.1   itojun 	sc->sc_if.if_timer = 0;
    569  1.1   itojun 	sc->sc_if.if_flags &= ~(IFF_RUNNING | IFF_UP);
    570  1.1   itojun 
    571  1.1   itojun 	splx(s);
    572  1.1   itojun 	return (0);
    573  1.1   itojun }
    574  1.1   itojun 
    575  1.1   itojun static void
    576  1.1   itojun netdock_watchdog(ifp)
    577  1.1   itojun 	struct ifnet *ifp;
    578  1.1   itojun {
    579  1.1   itojun 	struct netdock_softc *sc = ifp->if_softc;
    580  1.1   itojun 	int tmp;
    581  1.1   itojun 
    582  1.1   itojun 	printf("netdock_watchdog: resetting chip\n");
    583  1.1   itojun 	tmp = ifp->if_flags & IFF_UP;
    584  1.1   itojun 	netdock_reset(sc);
    585  1.1   itojun 	ifp->if_flags |= tmp;
    586  1.1   itojun }
    587  1.1   itojun 
    588  1.1   itojun static u_int
    589  1.1   itojun netdock_put(sc, m0)
    590  1.1   itojun 	struct netdock_softc *sc;
    591  1.1   itojun 	struct mbuf *m0;
    592  1.1   itojun {
    593  1.1   itojun 	struct mbuf *m;
    594  1.1   itojun 	u_int totlen = 0;
    595  1.1   itojun 	u_int tmplen;
    596  1.1   itojun 	int isr;
    597  1.1   itojun 	int timeout;
    598  1.1   itojun 	int tmp;
    599  1.1   itojun 	u_int i;
    600  1.1   itojun 
    601  1.1   itojun 	for (m = m0; m; m = m->m_next)
    602  1.1   itojun 		totlen += m->m_len;
    603  1.1   itojun 
    604  1.1   itojun 	if (totlen >= ETHER_MAX_LEN)
    605  1.1   itojun 		panic("%s: netdock_put: packet overflow", sc->sc_dev.dv_xname);
    606  1.1   itojun 
    607  1.1   itojun 	totlen += 6;
    608  1.1   itojun 	tmplen = totlen;
    609  1.1   itojun 	tmplen &= 0xff00;
    610  1.1   itojun 	tmplen |= 0x2000;
    611  1.1   itojun 	NIC_PUT_2(sc, REG_0000, tmplen);
    612  1.1   itojun 
    613  1.1   itojun 	timeout = 0x3000;
    614  1.1   itojun 	while ((((isr = NIC_GET_2(sc, REG_ISR)) & ISR_READY) == 0) &&
    615  1.1   itojun 	    timeout--) {
    616  1.1   itojun 		if (isr & ISR_TX)
    617  1.1   itojun 			netdock_txint(sc);
    618  1.1   itojun 	}
    619  1.1   itojun 	if (timeout == 0)
    620  1.1   itojun 		return (0);
    621  1.1   itojun 
    622  1.1   itojun 	tmp = NIC_GET_2(sc, REG_0002);
    623  1.1   itojun 	tmp <<= 8;
    624  1.1   itojun 	NIC_PUT_2(sc, REG_0002, tmp);
    625  1.1   itojun 	NIC_PUT_2(sc, REG_0006, 0x240);
    626  1.1   itojun 	NIC_GET_2(sc, REG_ISR);
    627  1.1   itojun 	tmplen = ((totlen << 8) & 0xfe00) | ((totlen >> 8) & 0x00ff);
    628  1.1   itojun 	NIC_PUT_2(sc, REG_DATA, tmplen);
    629  1.1   itojun 
    630  1.1   itojun 	for (m = m0; m; m = m->m_next) {
    631  1.1   itojun 		u_char *data = mtod(m, u_char *);
    632  1.1   itojun 		int len = m->m_len;
    633  1.1   itojun 		int len4 = len >> 2;
    634  1.1   itojun 		u_int32_t *data4 = (u_int32_t *)data;
    635  1.1   itojun 		for (i = 0; i < len4; i++)
    636  1.1   itojun 			NIC_PUT_4(sc, REG_DATA, data4[i]);
    637  1.1   itojun 		for (i = len4 << 2; i < len; i++)
    638  1.1   itojun 			NIC_PUT_1(sc, REG_DATA, data[i]);
    639  1.1   itojun 	}
    640  1.1   itojun 
    641  1.1   itojun 	if (totlen & 0x01)
    642  1.1   itojun 		NIC_PUT_2(sc, REG_DATA, 0x2020);
    643  1.1   itojun 	else
    644  1.1   itojun 		NIC_PUT_2(sc, REG_DATA, 0);
    645  1.1   itojun 
    646  1.1   itojun 	NIC_PUT_2(sc, REG_0000, 0xc000);
    647  1.1   itojun 
    648  1.1   itojun 	m_freem(m0);
    649  1.1   itojun 	/* sc->sc_if.if_timer = 5; */
    650  1.1   itojun 	return (totlen);
    651  1.1   itojun }
    652  1.1   itojun 
    653  1.1   itojun void
    654  1.1   itojun netdock_intr(arg)
    655  1.1   itojun 	void *arg;
    656  1.1   itojun {
    657  1.1   itojun 	struct netdock_softc *sc = (struct netdock_softc *)arg;
    658  1.1   itojun 	int isr;
    659  1.1   itojun 	int tmp;
    660  1.1   itojun 
    661  1.1   itojun 	NIC_PUT_2(sc, REG_ISR, 0);
    662  1.1   itojun 	while ((isr = (NIC_GET_2(sc, REG_ISR) & ISR_ALL)) != 0) {
    663  1.1   itojun 		if (isr & ISR_TX)
    664  1.1   itojun 			netdock_txint(sc);
    665  1.1   itojun 
    666  1.1   itojun 		if (isr & ISR_RX)
    667  1.1   itojun 			netdock_rxint(sc);
    668  1.1   itojun 
    669  1.1   itojun 		if (isr & (ISR_BIT_0C | ISR_BIT_0D)) {
    670  1.1   itojun 			if (isr & ISR_BIT_0C) {
    671  1.1   itojun 				NIC_PUT_2(sc, REG_000E, 0);
    672  1.1   itojun 				NIC_BSET(sc, REG_0004, 0x08);
    673  1.1   itojun 				NIC_PUT_2(sc, REG_000E, 0x0200);
    674  1.1   itojun 			}
    675  1.1   itojun 			if (isr & ISR_BIT_0D) {
    676  1.1   itojun 				NIC_PUT_2(sc, REG_000E, 0);
    677  1.1   itojun 				tmp = NIC_GET_2(sc, REG_0002);
    678  1.1   itojun 				if (tmp & REG_0002_BIT_04)
    679  1.1   itojun 					NIC_GET_2(sc, REG_0006);
    680  1.1   itojun 				tmp = NIC_GET_2(sc, REG_0000);
    681  1.1   itojun 				if (tmp & REG_0000_BIT_08)
    682  1.1   itojun 					NIC_BSET(sc, REG_0000, 0x08);
    683  1.1   itojun 				NIC_PUT_2(sc, REG_000E, 0x0200);
    684  1.1   itojun 			}
    685  1.1   itojun 			NIC_PUT_2(sc, REG_ISR, isr);
    686  1.1   itojun 		}
    687  1.1   itojun 	}
    688  1.1   itojun 	NIC_PUT_2(sc, REG_ISR, ISR_MASK);
    689  1.1   itojun }
    690  1.1   itojun 
    691  1.1   itojun static void
    692  1.1   itojun netdock_txint(sc)
    693  1.1   itojun 	struct netdock_softc *sc;
    694  1.1   itojun {
    695  1.1   itojun 	struct ifnet *ifp = &sc->sc_if;
    696  1.1   itojun 	int savereg0002;
    697  1.1   itojun 	int reg0004;
    698  1.1   itojun 	int regdata;
    699  1.1   itojun 
    700  1.1   itojun 	ifp->if_flags &= ~IFF_OACTIVE;
    701  1.1   itojun 	ifp->if_timer = 0;
    702  1.1   itojun 
    703  1.1   itojun 	savereg0002 = NIC_GET_2(sc, REG_0002);
    704  1.1   itojun 
    705  1.1   itojun 	while (((reg0004 = NIC_GET_2(sc, REG_0004)) & REG_0004_BIT_0F) == 0) {
    706  1.1   itojun 		NIC_PUT_2(sc, REG_0002, reg0004);
    707  1.1   itojun 		NIC_PUT_2(sc, REG_0006, 0x0060);
    708  1.1   itojun 		NIC_GET_2(sc, REG_ISR);
    709  1.1   itojun 		regdata = NIC_GET_2(sc, REG_DATA);
    710  1.1   itojun 		if ((regdata & REG_DATA_BIT_08) == 0) {
    711  1.1   itojun 			/* ifp->if_collisions++; */
    712  1.1   itojun 			if (regdata & REG_DATA_BIT_07)
    713  1.1   itojun 			/* ifp->if_oerrors++; */
    714  1.1   itojun 			NIC_PUT_2(sc, REG_000E, 0);
    715  1.1   itojun 			NIC_ORW(sc, REG_0000, 0x0100);
    716  1.1   itojun 			NIC_PUT_2(sc, REG_000E, 0x0200);
    717  1.1   itojun 		}
    718  1.1   itojun 		NIC_GET_2(sc ,REG_DATA);
    719  1.1   itojun 
    720  1.1   itojun 		if (regdata & REG_DATA_BIT_0F)
    721  1.1   itojun 			NIC_GET_4(sc, REG_EFD00);
    722  1.1   itojun 		NIC_PUT_2(sc, REG_0000, 0xa000);
    723  1.1   itojun 		NIC_PUT_2(sc, REG_ISR, ISR_TX);
    724  1.1   itojun 	}
    725  1.1   itojun 
    726  1.1   itojun 	NIC_PUT_2(sc, REG_0002, savereg0002);
    727  1.1   itojun 	NIC_PUT_2(sc, REG_000E, 0);
    728  1.1   itojun 	NIC_GET_2(sc, REG_0006);
    729  1.1   itojun 	NIC_PUT_2(sc, REG_000E, 0x0200);
    730  1.1   itojun 	NIC_PUT_2(sc, REG_0006, 0);
    731  1.1   itojun }
    732  1.1   itojun 
    733  1.1   itojun static void
    734  1.1   itojun netdock_rxint(sc)
    735  1.1   itojun 	struct netdock_softc *sc;
    736  1.1   itojun {
    737  1.1   itojun 	struct ifnet *ifp = &sc->sc_if;
    738  1.1   itojun 	int regdata1;
    739  1.1   itojun 	int regdata2;
    740  1.1   itojun 	u_int len;
    741  1.1   itojun 	int timeout;
    742  1.1   itojun 
    743  1.1   itojun 	while ((NIC_GET_2(sc, REG_0004) & REG_0004_BIT_07) == 0) {
    744  1.1   itojun 		NIC_GET_2(sc, REG_ISR);
    745  1.1   itojun 		NIC_PUT_2(sc, REG_0006, 0x00e0);
    746  1.1   itojun 		NIC_GET_2(sc, REG_ISR);
    747  1.1   itojun 		regdata1 = NIC_GET_2(sc, REG_DATA);
    748  1.1   itojun 		regdata2 = NIC_GET_2(sc, REG_DATA);
    749  1.1   itojun 		len = ((regdata2 << 8) & 0x0700) | ((regdata2 >> 8) & 0x00ff);
    750  1.1   itojun 
    751  1.1   itojun #if 0
    752  1.1   itojun 		printf("netdock_rxint: r1=0x%04x, r2=0x%04x, len=%d\n",
    753  1.1   itojun 		       regdata1, regdata2, len);
    754  1.1   itojun #endif
    755  1.1   itojun 
    756  1.1   itojun 		if ((regdata1 & REG_DATA_BIT_04) == 0)
    757  1.1   itojun 			len -= 2;
    758  1.1   itojun 
    759  1.1   itojun 		if ((regdata1 & 0x00ac) == 0) {
    760  1.1   itojun 			if (netdock_read(sc, len))
    761  1.1   itojun 				ifp->if_ipackets++;
    762  1.1   itojun 			else
    763  1.1   itojun 				ifp->if_ierrors++;
    764  1.1   itojun 		} else {
    765  1.1   itojun 			ifp->if_ierrors++;
    766  1.1   itojun 
    767  1.1   itojun 			if (regdata1 & REG_DATA_BIT_02)
    768  1.1   itojun 				NIC_GET_4(sc, REG_EFD00);
    769  1.1   itojun 			if (regdata1 & REG_DATA_BIT_03)
    770  1.1   itojun 				;
    771  1.1   itojun 			if (regdata1 & REG_DATA_BIT_05)
    772  1.1   itojun 				NIC_GET_4(sc, REG_EFD00);
    773  1.1   itojun 			if (regdata1 & REG_DATA_BIT_07)
    774  1.1   itojun 				;
    775  1.1   itojun 		}
    776  1.1   itojun 
    777  1.1   itojun 		timeout = 0x14;
    778  1.1   itojun 		while ((NIC_GET_2(sc, REG_0000) & REG_0000_BIT_08) && timeout--)
    779  1.1   itojun 			;
    780  1.1   itojun 		if (timeout == 0)
    781  1.1   itojun 			;
    782  1.1   itojun 
    783  1.1   itojun 		NIC_PUT_2(sc, REG_0000, 0x8000);
    784  1.1   itojun 	}
    785  1.1   itojun 	NIC_PUT_2(sc, REG_0006, 0);
    786  1.1   itojun }
    787  1.1   itojun 
    788  1.1   itojun static int
    789  1.1   itojun netdock_read(sc, len)
    790  1.1   itojun 	struct netdock_softc *sc;
    791  1.1   itojun 	int len;
    792  1.1   itojun {
    793  1.1   itojun 	struct ifnet *ifp = &sc->sc_if;
    794  1.1   itojun 	struct mbuf *m;
    795  1.1   itojun 
    796  1.1   itojun 	m = netdock_get(sc, len);
    797  1.1   itojun 	if (m == 0)
    798  1.1   itojun 		return (0);
    799  1.1   itojun 
    800  1.1   itojun 	/* the data comes with frame checksum and ethernet header */
    801  1.1   itojun 	m->m_flags |= M_HASFCS;
    802  1.1   itojun 
    803  1.1   itojun #if NBPFILTER > 0
    804  1.1   itojun 	if (ifp->if_bpf)
    805  1.1   itojun 		bpf_mtap(ifp->if_bpf, m);
    806  1.1   itojun #endif
    807  1.1   itojun 
    808  1.1   itojun 	(*ifp->if_input)(ifp, m);
    809  1.1   itojun 
    810  1.1   itojun 	return (1);
    811  1.1   itojun }
    812  1.1   itojun 
    813  1.1   itojun static struct mbuf *
    814  1.1   itojun netdock_get(sc, datalen)
    815  1.1   itojun 	struct netdock_softc *sc;
    816  1.1   itojun 	int datalen;
    817  1.1   itojun {
    818  1.1   itojun 	struct mbuf *m, *top, **mp;
    819  1.1   itojun 	u_char *data;
    820  1.1   itojun 	int i;
    821  1.1   itojun 	int len;
    822  1.1   itojun 	int len4;
    823  1.1   itojun 	u_int32_t *data4;
    824  1.1   itojun 
    825  1.1   itojun 	MGETHDR(m, M_DONTWAIT, MT_DATA);
    826  1.1   itojun 	if (m == NULL)
    827  1.1   itojun 		return (NULL);
    828  1.1   itojun 	m->m_pkthdr.rcvif = &sc->sc_if;
    829  1.1   itojun 	m->m_pkthdr.len = datalen;
    830  1.1   itojun 	len = MHLEN;
    831  1.1   itojun 	top = NULL;
    832  1.1   itojun 	mp = &top;
    833  1.1   itojun 
    834  1.1   itojun 	while (datalen > 0) {
    835  1.1   itojun 		if (top) {
    836  1.1   itojun 			MGET(m, M_DONTWAIT, MT_DATA);
    837  1.1   itojun 			if (m == 0) {
    838  1.1   itojun 				m_freem(top);
    839  1.1   itojun 				return (NULL);
    840  1.1   itojun 			}
    841  1.1   itojun 			len = MLEN;
    842  1.1   itojun 		}
    843  1.1   itojun 		if (datalen >= MINCLSIZE) {
    844  1.1   itojun 			MCLGET(m, M_DONTWAIT);
    845  1.1   itojun 			if ((m->m_flags & M_EXT) == 0) {
    846  1.1   itojun 				if (top)
    847  1.1   itojun 					m_freem(top);
    848  1.1   itojun 				return (NULL);
    849  1.1   itojun 			}
    850  1.1   itojun 			len = MCLBYTES;
    851  1.1   itojun 		}
    852  1.1   itojun 
    853  1.1   itojun 		if (mp == &top) {
    854  1.1   itojun 			caddr_t newdata = (caddr_t)
    855  1.1   itojun 			    ALIGN(m->m_data + sizeof(struct ether_header)) -
    856  1.1   itojun 			    sizeof(struct ether_header);
    857  1.1   itojun 			len -= newdata - m->m_data;
    858  1.1   itojun 			m->m_data = newdata;
    859  1.1   itojun 		}
    860  1.1   itojun 
    861  1.1   itojun 		m->m_len = len = min(datalen, len);
    862  1.1   itojun 
    863  1.1   itojun 		data = mtod(m, u_char *);
    864  1.1   itojun 		len4 = len >> 2;
    865  1.1   itojun 		data4 = (u_int32_t *)data;
    866  1.1   itojun 		for (i = 0; i < len4; i++)
    867  1.1   itojun 			data4[i] = NIC_GET_4(sc, REG_DATA);
    868  1.1   itojun 		for (i = len4 << 2; i < len; i++)
    869  1.1   itojun 			data[i] = NIC_GET_1(sc, REG_DATA);
    870  1.1   itojun 
    871  1.1   itojun 		datalen -= len;
    872  1.1   itojun 		*mp = m;
    873  1.1   itojun 		mp = &m->m_next;
    874  1.1   itojun 	}
    875  1.1   itojun 
    876  1.1   itojun 	return (top);
    877  1.1   itojun }
    878