Home | History | Annotate | Line # | Download | only in nubus
if_netdock_nubus.c revision 1.3.6.4
      1  1.3.6.4    skrll /*	$NetBSD: if_netdock_nubus.c,v 1.3.6.4 2004/11/02 07:50:36 skrll 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.1   itojun 
     45  1.3.6.1    skrll #include <sys/cdefs.h>
     46  1.3.6.4    skrll __KERNEL_RCSID(0, "$NetBSD: if_netdock_nubus.c,v 1.3.6.4 2004/11/02 07:50:36 skrll Exp $");
     47  1.3.6.1    skrll 
     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.3.6.4    skrll 			if (ifp->if_flags & IFF_RUNNING) {
    446  1.3.6.4    skrll 				temp = ifp->if_flags & IFF_UP;
    447  1.3.6.4    skrll 				netdock_reset(sc);
    448  1.3.6.4    skrll 				ifp->if_flags |= temp;
    449  1.3.6.4    skrll 			}
    450      1.1   itojun 			err = 0;
    451      1.1   itojun 		}
    452      1.1   itojun 		break;
    453      1.1   itojun 	default:
    454      1.1   itojun 		err = EINVAL;
    455      1.1   itojun 		break;
    456      1.1   itojun 	}
    457      1.1   itojun 	splx(s);
    458      1.1   itojun 	return (err);
    459      1.1   itojun }
    460      1.1   itojun 
    461      1.1   itojun static void
    462      1.1   itojun netdock_start(ifp)
    463      1.1   itojun 	struct ifnet *ifp;
    464      1.1   itojun {
    465      1.1   itojun 	struct netdock_softc *sc = ifp->if_softc;
    466      1.1   itojun 	struct mbuf *m;
    467      1.1   itojun 
    468      1.1   itojun 	if ((ifp->if_flags & (IFF_RUNNING | IFF_OACTIVE)) != IFF_RUNNING)
    469      1.1   itojun 		return;
    470      1.1   itojun 
    471      1.1   itojun 	while (1) {
    472      1.1   itojun 		IF_DEQUEUE(&ifp->if_snd, m);
    473      1.1   itojun 		if (m == 0)
    474      1.1   itojun 			return;
    475      1.1   itojun 
    476      1.1   itojun 		if ((m->m_flags & M_PKTHDR) == 0)
    477      1.1   itojun 			panic("%s: netdock_start: no header mbuf",
    478      1.1   itojun 				sc->sc_dev.dv_xname);
    479      1.1   itojun 
    480      1.1   itojun #if NBPFILTER > 0
    481      1.1   itojun 		if (ifp->if_bpf)
    482      1.1   itojun 			bpf_mtap(ifp->if_bpf, m);
    483      1.1   itojun #endif
    484      1.1   itojun 
    485      1.1   itojun 		if ((netdock_put(sc, m)) == 0) {
    486      1.1   itojun 			IF_PREPEND(&ifp->if_snd, m);
    487      1.1   itojun 			return;
    488      1.1   itojun 		}
    489      1.1   itojun 
    490      1.1   itojun 		ifp->if_opackets++;
    491      1.1   itojun 	}
    492      1.1   itojun 
    493      1.1   itojun }
    494      1.1   itojun 
    495      1.1   itojun static void
    496      1.1   itojun netdock_reset(sc)
    497      1.1   itojun 	struct netdock_softc *sc;
    498      1.1   itojun {
    499      1.1   itojun 
    500      1.1   itojun 	netdock_stop(sc);
    501      1.1   itojun 	netdock_init(sc);
    502      1.1   itojun }
    503      1.1   itojun 
    504      1.1   itojun static int
    505      1.1   itojun netdock_init(sc)
    506      1.1   itojun 	struct netdock_softc *sc;
    507      1.1   itojun {
    508      1.1   itojun 	int s;
    509      1.1   itojun 	int saveisr;
    510      1.1   itojun 	int savetmp;
    511      1.1   itojun 
    512      1.1   itojun 	if (sc->sc_if.if_flags & IFF_RUNNING)
    513      1.1   itojun 		return (0);
    514      1.1   itojun 
    515      1.1   itojun 	s = splnet();
    516      1.1   itojun 
    517      1.1   itojun 	/* 0606 */
    518      1.1   itojun 	NIC_PUT_2(sc, REG_000E, 0x0200);
    519      1.1   itojun 	NIC_PUT_2(sc, REG_ISR , 0);
    520      1.1   itojun 	NIC_PUT_2(sc, REG_000E, 0);
    521      1.1   itojun 
    522      1.1   itojun 	NIC_PUT_2(sc, REG_0000, 0x8104);
    523      1.1   itojun 	NIC_PUT_2(sc, REG_0004, 0x0043);
    524      1.1   itojun 	NIC_PUT_2(sc, REG_000E, 0x0100);
    525      1.1   itojun 	NIC_PUT_2(sc, REG_0002, 0x6618);
    526      1.1   itojun 	NIC_PUT_2(sc, REG_0000, 0x8010);
    527      1.1   itojun 
    528      1.1   itojun 	NIC_PUT_1(sc, REG_0004 + 0, sc->sc_enaddr[0]);
    529      1.1   itojun 	NIC_PUT_1(sc, REG_0004 + 1, sc->sc_enaddr[1]);
    530      1.1   itojun 	NIC_PUT_1(sc, REG_0004 + 2, sc->sc_enaddr[2]);
    531      1.1   itojun 	NIC_PUT_1(sc, REG_0004 + 3, sc->sc_enaddr[3]);
    532      1.1   itojun 	NIC_PUT_1(sc, REG_0004 + 4, sc->sc_enaddr[4]);
    533      1.1   itojun 	NIC_PUT_1(sc, REG_0004 + 5, sc->sc_enaddr[5]);
    534      1.1   itojun 
    535      1.1   itojun 	NIC_PUT_2(sc, REG_ISR , 0x2008);
    536      1.1   itojun 	NIC_PUT_2(sc, REG_000E, 0x0200);
    537      1.1   itojun 	NIC_PUT_2(sc, REG_0000, 0x4000);
    538      1.1   itojun 	NIC_PUT_2(sc, REG_ISR, ISR_MASK);
    539      1.1   itojun 
    540      1.1   itojun 
    541      1.1   itojun 	/* 1320 */
    542      1.1   itojun 	saveisr = NIC_GET_2(sc, REG_ISR);
    543      1.1   itojun 	NIC_PUT_2(sc, REG_ISR , 0);
    544      1.1   itojun 	savetmp = NIC_GET_2(sc, REG_000E);
    545      1.1   itojun 	NIC_PUT_2(sc, REG_000E, 0x0100);
    546      1.1   itojun 	NIC_ANDW(sc, REG_ISR, ~ISR_BIT_03);
    547      1.1   itojun 	NIC_PUT_2(sc, REG_000E, savetmp);
    548      1.1   itojun 
    549      1.1   itojun 	/* 1382 */
    550      1.1   itojun 	savetmp = NIC_GET_2(sc, REG_000E);
    551      1.1   itojun 	NIC_PUT_2(sc, REG_000E, 0x0100);
    552      1.1   itojun 	NIC_ORW(sc, REG_ISR, ISR_BIT_03);
    553      1.1   itojun 	NIC_PUT_2(sc, REG_000E, savetmp);
    554      1.1   itojun 	NIC_PUT_2(sc, REG_ISR , saveisr);
    555      1.1   itojun 
    556      1.1   itojun 
    557      1.1   itojun 	sc->sc_if.if_flags |= IFF_RUNNING;
    558      1.1   itojun 	sc->sc_if.if_flags &= ~IFF_OACTIVE;
    559      1.1   itojun 
    560      1.1   itojun 	splx(s);
    561      1.1   itojun 	return (0);
    562      1.1   itojun }
    563      1.1   itojun 
    564      1.1   itojun static int
    565      1.1   itojun netdock_stop(sc)
    566      1.1   itojun 	struct netdock_softc *sc;
    567      1.1   itojun {
    568      1.1   itojun 	int s = splnet();
    569      1.1   itojun 
    570      1.1   itojun 	sc->sc_if.if_timer = 0;
    571      1.1   itojun 	sc->sc_if.if_flags &= ~(IFF_RUNNING | IFF_UP);
    572      1.1   itojun 
    573      1.1   itojun 	splx(s);
    574      1.1   itojun 	return (0);
    575      1.1   itojun }
    576      1.1   itojun 
    577      1.1   itojun static void
    578      1.1   itojun netdock_watchdog(ifp)
    579      1.1   itojun 	struct ifnet *ifp;
    580      1.1   itojun {
    581      1.1   itojun 	struct netdock_softc *sc = ifp->if_softc;
    582      1.1   itojun 	int tmp;
    583      1.1   itojun 
    584      1.1   itojun 	printf("netdock_watchdog: resetting chip\n");
    585      1.1   itojun 	tmp = ifp->if_flags & IFF_UP;
    586      1.1   itojun 	netdock_reset(sc);
    587      1.1   itojun 	ifp->if_flags |= tmp;
    588      1.1   itojun }
    589      1.1   itojun 
    590      1.1   itojun static u_int
    591      1.1   itojun netdock_put(sc, m0)
    592      1.1   itojun 	struct netdock_softc *sc;
    593      1.1   itojun 	struct mbuf *m0;
    594      1.1   itojun {
    595      1.1   itojun 	struct mbuf *m;
    596      1.1   itojun 	u_int totlen = 0;
    597      1.1   itojun 	u_int tmplen;
    598      1.1   itojun 	int isr;
    599      1.1   itojun 	int timeout;
    600      1.1   itojun 	int tmp;
    601      1.1   itojun 	u_int i;
    602      1.1   itojun 
    603      1.1   itojun 	for (m = m0; m; m = m->m_next)
    604      1.1   itojun 		totlen += m->m_len;
    605      1.1   itojun 
    606      1.1   itojun 	if (totlen >= ETHER_MAX_LEN)
    607      1.1   itojun 		panic("%s: netdock_put: packet overflow", sc->sc_dev.dv_xname);
    608      1.1   itojun 
    609      1.1   itojun 	totlen += 6;
    610      1.1   itojun 	tmplen = totlen;
    611      1.1   itojun 	tmplen &= 0xff00;
    612      1.1   itojun 	tmplen |= 0x2000;
    613      1.1   itojun 	NIC_PUT_2(sc, REG_0000, tmplen);
    614      1.1   itojun 
    615      1.1   itojun 	timeout = 0x3000;
    616      1.1   itojun 	while ((((isr = NIC_GET_2(sc, REG_ISR)) & ISR_READY) == 0) &&
    617      1.1   itojun 	    timeout--) {
    618      1.1   itojun 		if (isr & ISR_TX)
    619      1.1   itojun 			netdock_txint(sc);
    620      1.1   itojun 	}
    621      1.1   itojun 	if (timeout == 0)
    622      1.1   itojun 		return (0);
    623      1.1   itojun 
    624      1.1   itojun 	tmp = NIC_GET_2(sc, REG_0002);
    625      1.1   itojun 	tmp <<= 8;
    626      1.1   itojun 	NIC_PUT_2(sc, REG_0002, tmp);
    627      1.1   itojun 	NIC_PUT_2(sc, REG_0006, 0x240);
    628      1.1   itojun 	NIC_GET_2(sc, REG_ISR);
    629      1.1   itojun 	tmplen = ((totlen << 8) & 0xfe00) | ((totlen >> 8) & 0x00ff);
    630      1.1   itojun 	NIC_PUT_2(sc, REG_DATA, tmplen);
    631      1.1   itojun 
    632      1.1   itojun 	for (m = m0; m; m = m->m_next) {
    633      1.1   itojun 		u_char *data = mtod(m, u_char *);
    634      1.1   itojun 		int len = m->m_len;
    635      1.1   itojun 		int len4 = len >> 2;
    636      1.1   itojun 		u_int32_t *data4 = (u_int32_t *)data;
    637      1.1   itojun 		for (i = 0; i < len4; i++)
    638      1.1   itojun 			NIC_PUT_4(sc, REG_DATA, data4[i]);
    639      1.1   itojun 		for (i = len4 << 2; i < len; i++)
    640      1.1   itojun 			NIC_PUT_1(sc, REG_DATA, data[i]);
    641      1.1   itojun 	}
    642      1.1   itojun 
    643      1.1   itojun 	if (totlen & 0x01)
    644      1.1   itojun 		NIC_PUT_2(sc, REG_DATA, 0x2020);
    645      1.1   itojun 	else
    646      1.1   itojun 		NIC_PUT_2(sc, REG_DATA, 0);
    647      1.1   itojun 
    648      1.1   itojun 	NIC_PUT_2(sc, REG_0000, 0xc000);
    649      1.1   itojun 
    650      1.1   itojun 	m_freem(m0);
    651      1.1   itojun 	/* sc->sc_if.if_timer = 5; */
    652      1.1   itojun 	return (totlen);
    653      1.1   itojun }
    654      1.1   itojun 
    655      1.1   itojun void
    656      1.1   itojun netdock_intr(arg)
    657      1.1   itojun 	void *arg;
    658      1.1   itojun {
    659      1.1   itojun 	struct netdock_softc *sc = (struct netdock_softc *)arg;
    660      1.1   itojun 	int isr;
    661      1.1   itojun 	int tmp;
    662      1.1   itojun 
    663      1.1   itojun 	NIC_PUT_2(sc, REG_ISR, 0);
    664      1.1   itojun 	while ((isr = (NIC_GET_2(sc, REG_ISR) & ISR_ALL)) != 0) {
    665      1.1   itojun 		if (isr & ISR_TX)
    666      1.1   itojun 			netdock_txint(sc);
    667      1.1   itojun 
    668      1.1   itojun 		if (isr & ISR_RX)
    669      1.1   itojun 			netdock_rxint(sc);
    670      1.1   itojun 
    671      1.1   itojun 		if (isr & (ISR_BIT_0C | ISR_BIT_0D)) {
    672      1.1   itojun 			if (isr & ISR_BIT_0C) {
    673      1.1   itojun 				NIC_PUT_2(sc, REG_000E, 0);
    674      1.1   itojun 				NIC_BSET(sc, REG_0004, 0x08);
    675      1.1   itojun 				NIC_PUT_2(sc, REG_000E, 0x0200);
    676      1.1   itojun 			}
    677      1.1   itojun 			if (isr & ISR_BIT_0D) {
    678      1.1   itojun 				NIC_PUT_2(sc, REG_000E, 0);
    679      1.1   itojun 				tmp = NIC_GET_2(sc, REG_0002);
    680      1.1   itojun 				if (tmp & REG_0002_BIT_04)
    681      1.1   itojun 					NIC_GET_2(sc, REG_0006);
    682      1.1   itojun 				tmp = NIC_GET_2(sc, REG_0000);
    683      1.1   itojun 				if (tmp & REG_0000_BIT_08)
    684      1.1   itojun 					NIC_BSET(sc, REG_0000, 0x08);
    685      1.1   itojun 				NIC_PUT_2(sc, REG_000E, 0x0200);
    686      1.1   itojun 			}
    687      1.1   itojun 			NIC_PUT_2(sc, REG_ISR, isr);
    688      1.1   itojun 		}
    689      1.1   itojun 	}
    690      1.1   itojun 	NIC_PUT_2(sc, REG_ISR, ISR_MASK);
    691      1.1   itojun }
    692      1.1   itojun 
    693      1.1   itojun static void
    694      1.1   itojun netdock_txint(sc)
    695      1.1   itojun 	struct netdock_softc *sc;
    696      1.1   itojun {
    697      1.1   itojun 	struct ifnet *ifp = &sc->sc_if;
    698      1.1   itojun 	int savereg0002;
    699      1.1   itojun 	int reg0004;
    700      1.1   itojun 	int regdata;
    701      1.1   itojun 
    702      1.1   itojun 	ifp->if_flags &= ~IFF_OACTIVE;
    703      1.1   itojun 	ifp->if_timer = 0;
    704      1.1   itojun 
    705      1.1   itojun 	savereg0002 = NIC_GET_2(sc, REG_0002);
    706      1.1   itojun 
    707      1.1   itojun 	while (((reg0004 = NIC_GET_2(sc, REG_0004)) & REG_0004_BIT_0F) == 0) {
    708      1.1   itojun 		NIC_PUT_2(sc, REG_0002, reg0004);
    709      1.1   itojun 		NIC_PUT_2(sc, REG_0006, 0x0060);
    710      1.1   itojun 		NIC_GET_2(sc, REG_ISR);
    711      1.1   itojun 		regdata = NIC_GET_2(sc, REG_DATA);
    712      1.1   itojun 		if ((regdata & REG_DATA_BIT_08) == 0) {
    713      1.1   itojun 			/* ifp->if_collisions++; */
    714      1.1   itojun 			if (regdata & REG_DATA_BIT_07)
    715      1.1   itojun 			/* ifp->if_oerrors++; */
    716      1.1   itojun 			NIC_PUT_2(sc, REG_000E, 0);
    717      1.1   itojun 			NIC_ORW(sc, REG_0000, 0x0100);
    718      1.1   itojun 			NIC_PUT_2(sc, REG_000E, 0x0200);
    719      1.1   itojun 		}
    720      1.1   itojun 		NIC_GET_2(sc ,REG_DATA);
    721      1.1   itojun 
    722      1.1   itojun 		if (regdata & REG_DATA_BIT_0F)
    723      1.1   itojun 			NIC_GET_4(sc, REG_EFD00);
    724      1.1   itojun 		NIC_PUT_2(sc, REG_0000, 0xa000);
    725      1.1   itojun 		NIC_PUT_2(sc, REG_ISR, ISR_TX);
    726      1.1   itojun 	}
    727      1.1   itojun 
    728      1.1   itojun 	NIC_PUT_2(sc, REG_0002, savereg0002);
    729      1.1   itojun 	NIC_PUT_2(sc, REG_000E, 0);
    730      1.1   itojun 	NIC_GET_2(sc, REG_0006);
    731      1.1   itojun 	NIC_PUT_2(sc, REG_000E, 0x0200);
    732      1.1   itojun 	NIC_PUT_2(sc, REG_0006, 0);
    733      1.1   itojun }
    734      1.1   itojun 
    735      1.1   itojun static void
    736      1.1   itojun netdock_rxint(sc)
    737      1.1   itojun 	struct netdock_softc *sc;
    738      1.1   itojun {
    739      1.1   itojun 	struct ifnet *ifp = &sc->sc_if;
    740      1.1   itojun 	int regdata1;
    741      1.1   itojun 	int regdata2;
    742      1.1   itojun 	u_int len;
    743      1.1   itojun 	int timeout;
    744      1.1   itojun 
    745      1.1   itojun 	while ((NIC_GET_2(sc, REG_0004) & REG_0004_BIT_07) == 0) {
    746      1.1   itojun 		NIC_GET_2(sc, REG_ISR);
    747      1.1   itojun 		NIC_PUT_2(sc, REG_0006, 0x00e0);
    748      1.1   itojun 		NIC_GET_2(sc, REG_ISR);
    749      1.1   itojun 		regdata1 = NIC_GET_2(sc, REG_DATA);
    750      1.1   itojun 		regdata2 = NIC_GET_2(sc, REG_DATA);
    751      1.1   itojun 		len = ((regdata2 << 8) & 0x0700) | ((regdata2 >> 8) & 0x00ff);
    752      1.1   itojun 
    753      1.1   itojun #if 0
    754      1.1   itojun 		printf("netdock_rxint: r1=0x%04x, r2=0x%04x, len=%d\n",
    755      1.1   itojun 		       regdata1, regdata2, len);
    756      1.1   itojun #endif
    757      1.1   itojun 
    758      1.1   itojun 		if ((regdata1 & REG_DATA_BIT_04) == 0)
    759      1.1   itojun 			len -= 2;
    760      1.1   itojun 
    761      1.1   itojun 		if ((regdata1 & 0x00ac) == 0) {
    762      1.1   itojun 			if (netdock_read(sc, len))
    763      1.1   itojun 				ifp->if_ipackets++;
    764      1.1   itojun 			else
    765      1.1   itojun 				ifp->if_ierrors++;
    766      1.1   itojun 		} else {
    767      1.1   itojun 			ifp->if_ierrors++;
    768      1.1   itojun 
    769      1.1   itojun 			if (regdata1 & REG_DATA_BIT_02)
    770      1.1   itojun 				NIC_GET_4(sc, REG_EFD00);
    771      1.1   itojun 			if (regdata1 & REG_DATA_BIT_03)
    772      1.1   itojun 				;
    773      1.1   itojun 			if (regdata1 & REG_DATA_BIT_05)
    774      1.1   itojun 				NIC_GET_4(sc, REG_EFD00);
    775      1.1   itojun 			if (regdata1 & REG_DATA_BIT_07)
    776      1.1   itojun 				;
    777      1.1   itojun 		}
    778      1.1   itojun 
    779      1.1   itojun 		timeout = 0x14;
    780      1.1   itojun 		while ((NIC_GET_2(sc, REG_0000) & REG_0000_BIT_08) && timeout--)
    781      1.1   itojun 			;
    782      1.1   itojun 		if (timeout == 0)
    783      1.1   itojun 			;
    784      1.1   itojun 
    785      1.1   itojun 		NIC_PUT_2(sc, REG_0000, 0x8000);
    786      1.1   itojun 	}
    787      1.1   itojun 	NIC_PUT_2(sc, REG_0006, 0);
    788      1.1   itojun }
    789      1.1   itojun 
    790      1.1   itojun static int
    791      1.1   itojun netdock_read(sc, len)
    792      1.1   itojun 	struct netdock_softc *sc;
    793      1.1   itojun 	int len;
    794      1.1   itojun {
    795      1.1   itojun 	struct ifnet *ifp = &sc->sc_if;
    796      1.1   itojun 	struct mbuf *m;
    797      1.1   itojun 
    798      1.1   itojun 	m = netdock_get(sc, len);
    799      1.1   itojun 	if (m == 0)
    800      1.1   itojun 		return (0);
    801      1.1   itojun 
    802      1.1   itojun 	/* the data comes with frame checksum and ethernet header */
    803      1.1   itojun 	m->m_flags |= M_HASFCS;
    804      1.1   itojun 
    805      1.1   itojun #if NBPFILTER > 0
    806      1.1   itojun 	if (ifp->if_bpf)
    807      1.1   itojun 		bpf_mtap(ifp->if_bpf, m);
    808      1.1   itojun #endif
    809      1.1   itojun 
    810      1.1   itojun 	(*ifp->if_input)(ifp, m);
    811      1.1   itojun 
    812      1.1   itojun 	return (1);
    813      1.1   itojun }
    814      1.1   itojun 
    815      1.1   itojun static struct mbuf *
    816      1.1   itojun netdock_get(sc, datalen)
    817      1.1   itojun 	struct netdock_softc *sc;
    818      1.1   itojun 	int datalen;
    819      1.1   itojun {
    820      1.1   itojun 	struct mbuf *m, *top, **mp;
    821      1.1   itojun 	u_char *data;
    822      1.1   itojun 	int i;
    823      1.1   itojun 	int len;
    824      1.1   itojun 	int len4;
    825      1.1   itojun 	u_int32_t *data4;
    826      1.1   itojun 
    827      1.1   itojun 	MGETHDR(m, M_DONTWAIT, MT_DATA);
    828      1.1   itojun 	if (m == NULL)
    829      1.1   itojun 		return (NULL);
    830      1.1   itojun 	m->m_pkthdr.rcvif = &sc->sc_if;
    831      1.1   itojun 	m->m_pkthdr.len = datalen;
    832      1.1   itojun 	len = MHLEN;
    833      1.1   itojun 	top = NULL;
    834      1.1   itojun 	mp = &top;
    835      1.1   itojun 
    836      1.1   itojun 	while (datalen > 0) {
    837      1.1   itojun 		if (top) {
    838      1.1   itojun 			MGET(m, M_DONTWAIT, MT_DATA);
    839      1.1   itojun 			if (m == 0) {
    840      1.1   itojun 				m_freem(top);
    841      1.1   itojun 				return (NULL);
    842      1.1   itojun 			}
    843      1.1   itojun 			len = MLEN;
    844      1.1   itojun 		}
    845      1.1   itojun 		if (datalen >= MINCLSIZE) {
    846      1.1   itojun 			MCLGET(m, M_DONTWAIT);
    847      1.1   itojun 			if ((m->m_flags & M_EXT) == 0) {
    848      1.1   itojun 				if (top)
    849      1.1   itojun 					m_freem(top);
    850      1.1   itojun 				return (NULL);
    851      1.1   itojun 			}
    852      1.1   itojun 			len = MCLBYTES;
    853      1.1   itojun 		}
    854      1.1   itojun 
    855      1.1   itojun 		if (mp == &top) {
    856      1.1   itojun 			caddr_t newdata = (caddr_t)
    857      1.1   itojun 			    ALIGN(m->m_data + sizeof(struct ether_header)) -
    858      1.1   itojun 			    sizeof(struct ether_header);
    859      1.1   itojun 			len -= newdata - m->m_data;
    860      1.1   itojun 			m->m_data = newdata;
    861      1.1   itojun 		}
    862      1.1   itojun 
    863      1.1   itojun 		m->m_len = len = min(datalen, len);
    864      1.1   itojun 
    865      1.1   itojun 		data = mtod(m, u_char *);
    866      1.1   itojun 		len4 = len >> 2;
    867      1.1   itojun 		data4 = (u_int32_t *)data;
    868      1.1   itojun 		for (i = 0; i < len4; i++)
    869      1.1   itojun 			data4[i] = NIC_GET_4(sc, REG_DATA);
    870      1.1   itojun 		for (i = len4 << 2; i < len; i++)
    871      1.1   itojun 			data[i] = NIC_GET_1(sc, REG_DATA);
    872      1.1   itojun 
    873      1.1   itojun 		datalen -= len;
    874      1.1   itojun 		*mp = m;
    875      1.1   itojun 		mp = &m->m_next;
    876      1.1   itojun 	}
    877      1.1   itojun 
    878      1.1   itojun 	return (top);
    879      1.1   itojun }
    880