Home | History | Annotate | Line # | Download | only in ic
lance.c revision 1.48
      1  1.48  riastrad /*	$NetBSD: lance.c,v 1.48 2015/04/13 16:33:24 riastradh Exp $	*/
      2   1.1  drochner 
      3   1.1  drochner /*-
      4   1.3   mycroft  * Copyright (c) 1997, 1998 The NetBSD Foundation, Inc.
      5   1.1  drochner  * All rights reserved.
      6   1.1  drochner  *
      7   1.1  drochner  * This code is derived from software contributed to The NetBSD Foundation
      8   1.3   mycroft  * by Charles M. Hannum and by Jason R. Thorpe of the Numerical Aerospace
      9   1.3   mycroft  * Simulation Facility, NASA Ames Research Center.
     10   1.1  drochner  *
     11   1.1  drochner  * Redistribution and use in source and binary forms, with or without
     12   1.1  drochner  * modification, are permitted provided that the following conditions
     13   1.1  drochner  * are met:
     14   1.1  drochner  * 1. Redistributions of source code must retain the above copyright
     15   1.1  drochner  *    notice, this list of conditions and the following disclaimer.
     16   1.1  drochner  * 2. Redistributions in binary form must reproduce the above copyright
     17   1.1  drochner  *    notice, this list of conditions and the following disclaimer in the
     18   1.1  drochner  *    documentation and/or other materials provided with the distribution.
     19   1.1  drochner  *
     20   1.1  drochner  * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
     21   1.1  drochner  * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
     22   1.1  drochner  * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
     23   1.1  drochner  * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
     24   1.1  drochner  * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
     25   1.1  drochner  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
     26   1.1  drochner  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
     27   1.1  drochner  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
     28   1.1  drochner  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
     29   1.1  drochner  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
     30   1.1  drochner  * POSSIBILITY OF SUCH DAMAGE.
     31   1.1  drochner  */
     32   1.1  drochner 
     33   1.1  drochner /*-
     34   1.1  drochner  * Copyright (c) 1992, 1993
     35   1.1  drochner  *	The Regents of the University of California.  All rights reserved.
     36   1.1  drochner  *
     37   1.1  drochner  * This code is derived from software contributed to Berkeley by
     38   1.1  drochner  * Ralph Campbell and Rick Macklem.
     39   1.1  drochner  *
     40   1.1  drochner  * Redistribution and use in source and binary forms, with or without
     41   1.1  drochner  * modification, are permitted provided that the following conditions
     42   1.1  drochner  * are met:
     43   1.1  drochner  * 1. Redistributions of source code must retain the above copyright
     44   1.1  drochner  *    notice, this list of conditions and the following disclaimer.
     45   1.1  drochner  * 2. Redistributions in binary form must reproduce the above copyright
     46   1.1  drochner  *    notice, this list of conditions and the following disclaimer in the
     47   1.1  drochner  *    documentation and/or other materials provided with the distribution.
     48  1.29       agc  * 3. Neither the name of the University nor the names of its contributors
     49   1.1  drochner  *    may be used to endorse or promote products derived from this software
     50   1.1  drochner  *    without specific prior written permission.
     51   1.1  drochner  *
     52   1.1  drochner  * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
     53   1.1  drochner  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
     54   1.1  drochner  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
     55   1.1  drochner  * ARE DISCLAIMED.  IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
     56   1.1  drochner  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
     57   1.1  drochner  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
     58   1.1  drochner  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
     59   1.1  drochner  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
     60   1.1  drochner  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
     61   1.1  drochner  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
     62   1.1  drochner  * SUCH DAMAGE.
     63   1.1  drochner  *
     64   1.1  drochner  *	@(#)if_le.c	8.2 (Berkeley) 11/16/93
     65   1.1  drochner  */
     66  1.26     lukem 
     67  1.26     lukem #include <sys/cdefs.h>
     68  1.48  riastrad __KERNEL_RCSID(0, "$NetBSD: lance.c,v 1.48 2015/04/13 16:33:24 riastradh Exp $");
     69   1.1  drochner 
     70   1.1  drochner #include <sys/param.h>
     71   1.1  drochner #include <sys/systm.h>
     72  1.32     perry #include <sys/mbuf.h>
     73   1.1  drochner #include <sys/syslog.h>
     74   1.1  drochner #include <sys/socket.h>
     75   1.1  drochner #include <sys/device.h>
     76   1.1  drochner #include <sys/malloc.h>
     77   1.1  drochner #include <sys/ioctl.h>
     78   1.1  drochner #include <sys/errno.h>
     79  1.48  riastrad #include <sys/rndsource.h>
     80   1.1  drochner 
     81   1.1  drochner #include <net/if.h>
     82   1.1  drochner #include <net/if_dl.h>
     83   1.1  drochner #include <net/if_ether.h>
     84   1.1  drochner #include <net/if_media.h>
     85   1.1  drochner 
     86   1.1  drochner 
     87   1.1  drochner #include <net/bpf.h>
     88   1.1  drochner #include <net/bpfdesc.h>
     89   1.1  drochner 
     90   1.1  drochner #include <dev/ic/lancereg.h>
     91   1.1  drochner #include <dev/ic/lancevar.h>
     92   1.1  drochner 
     93  1.19       mrg #if defined(_KERNEL_OPT)
     94   1.1  drochner #include "opt_ddb.h"
     95   1.1  drochner #endif
     96   1.1  drochner 
     97   1.1  drochner #ifdef DDB
     98   1.1  drochner #define	integrate
     99   1.1  drochner #define hide
    100   1.1  drochner #else
    101  1.34     perry #define	integrate	static inline
    102   1.1  drochner #define hide		static
    103   1.1  drochner #endif
    104   1.1  drochner 
    105  1.31     perry integrate struct mbuf *lance_get(struct lance_softc *, int, int);
    106   1.1  drochner 
    107  1.43   tsutsui hide bool lance_shutdown(device_t, int);
    108   1.1  drochner 
    109  1.31     perry int lance_mediachange(struct ifnet *);
    110  1.31     perry void lance_mediastatus(struct ifnet *, struct ifmediareq *);
    111   1.1  drochner 
    112  1.31     perry static inline u_int16_t ether_cmp(void *, void *);
    113   1.1  drochner 
    114  1.31     perry void lance_stop(struct ifnet *, int);
    115  1.38  christos int lance_ioctl(struct ifnet *, u_long, void *);
    116  1.31     perry void lance_watchdog(struct ifnet *);
    117   1.1  drochner 
    118   1.1  drochner /*
    119   1.1  drochner  * Compare two Ether/802 addresses for equality, inlined and
    120  1.23   thorpej  * unrolled for speed.  Use this like memcmp().
    121   1.1  drochner  *
    122   1.1  drochner  * XXX: Add <machine/inlines.h> for stuff like this?
    123   1.1  drochner  * XXX: or maybe add it to libkern.h instead?
    124   1.1  drochner  *
    125   1.1  drochner  * "I'd love to have an inline assembler version of this."
    126   1.1  drochner  * XXX: Who wanted that? mycroft?  I wrote one, but this
    127   1.1  drochner  * version in C is as good as hand-coded assembly. -gwr
    128   1.1  drochner  *
    129   1.1  drochner  * Please do NOT tweak this without looking at the actual
    130   1.1  drochner  * assembly code generated before and after your tweaks!
    131   1.1  drochner  */
    132  1.40   tsutsui static inline uint16_t
    133  1.40   tsutsui ether_cmp(void *one, void *two)
    134  1.40   tsutsui {
    135  1.40   tsutsui 	uint16_t *a = (uint16_t *)one;
    136  1.40   tsutsui 	uint16_t *b = (uint16_t *)two;
    137  1.40   tsutsui 	uint16_t diff;
    138   1.1  drochner 
    139   1.1  drochner #ifdef	m68k
    140   1.1  drochner 	/*
    141   1.1  drochner 	 * The post-increment-pointer form produces the best
    142   1.1  drochner 	 * machine code for m68k.  This was carefully tuned
    143   1.1  drochner 	 * so it compiles to just 8 short (2-byte) op-codes!
    144   1.1  drochner 	 */
    145   1.1  drochner 	diff  = *a++ - *b++;
    146   1.1  drochner 	diff |= *a++ - *b++;
    147   1.1  drochner 	diff |= *a++ - *b++;
    148   1.1  drochner #else
    149   1.1  drochner 	/*
    150   1.1  drochner 	 * Most modern CPUs do better with a single expresion.
    151   1.1  drochner 	 * Note that short-cut evaluation is NOT helpful here,
    152   1.1  drochner 	 * because it just makes the code longer, not faster!
    153   1.1  drochner 	 */
    154   1.1  drochner 	diff = (a[0] - b[0]) | (a[1] - b[1]) | (a[2] - b[2]);
    155   1.1  drochner #endif
    156   1.1  drochner 
    157   1.1  drochner 	return (diff);
    158   1.1  drochner }
    159   1.1  drochner 
    160   1.1  drochner #define ETHER_CMP	ether_cmp
    161   1.1  drochner 
    162   1.1  drochner #ifdef LANCE_REVC_BUG
    163   1.1  drochner /* Make sure this is short-aligned, for ether_cmp(). */
    164  1.40   tsutsui static uint16_t bcast_enaddr[3] = { ~0, ~0, ~0 };
    165   1.1  drochner #endif
    166   1.1  drochner 
    167   1.1  drochner void
    168  1.40   tsutsui lance_config(struct lance_softc *sc)
    169   1.1  drochner {
    170  1.18  jdolecek 	int i, nbuf;
    171  1.20  jdolecek 	struct ifnet *ifp = &sc->sc_ethercom.ec_if;
    172   1.1  drochner 
    173   1.1  drochner 	/* Initialize ifnet structure. */
    174  1.40   tsutsui 	strcpy(ifp->if_xname, device_xname(sc->sc_dev));
    175   1.1  drochner 	ifp->if_softc = sc;
    176   1.1  drochner 	ifp->if_start = sc->sc_start;
    177   1.1  drochner 	ifp->if_ioctl = lance_ioctl;
    178   1.1  drochner 	ifp->if_watchdog = lance_watchdog;
    179  1.20  jdolecek 	ifp->if_init = lance_init;
    180  1.20  jdolecek 	ifp->if_stop = lance_stop;
    181   1.1  drochner 	ifp->if_flags =
    182   1.1  drochner 	    IFF_BROADCAST | IFF_SIMPLEX | IFF_NOTRAILERS | IFF_MULTICAST;
    183   1.1  drochner #ifdef LANCE_REVC_BUG
    184   1.1  drochner 	ifp->if_flags &= ~IFF_MULTICAST;
    185   1.1  drochner #endif
    186  1.17   thorpej 	IFQ_SET_READY(&ifp->if_snd);
    187   1.1  drochner 
    188   1.1  drochner 	/* Initialize ifmedia structures. */
    189   1.1  drochner 	ifmedia_init(&sc->sc_media, 0, lance_mediachange, lance_mediastatus);
    190   1.1  drochner 	if (sc->sc_supmedia != NULL) {
    191   1.1  drochner 		for (i = 0; i < sc->sc_nsupmedia; i++)
    192   1.1  drochner 			ifmedia_add(&sc->sc_media, sc->sc_supmedia[i],
    193   1.1  drochner 			   0, NULL);
    194   1.1  drochner 		ifmedia_set(&sc->sc_media, sc->sc_defaultmedia);
    195   1.1  drochner 	} else {
    196   1.1  drochner 		ifmedia_add(&sc->sc_media, IFM_ETHER|IFM_MANUAL, 0, NULL);
    197   1.1  drochner 		ifmedia_set(&sc->sc_media, IFM_ETHER|IFM_MANUAL);
    198   1.1  drochner 	}
    199   1.1  drochner 
    200   1.1  drochner 	switch (sc->sc_memsize) {
    201   1.1  drochner 	case 8192:
    202   1.1  drochner 		sc->sc_nrbuf = 4;
    203   1.1  drochner 		sc->sc_ntbuf = 1;
    204   1.1  drochner 		break;
    205   1.1  drochner 	case 16384:
    206   1.1  drochner 		sc->sc_nrbuf = 8;
    207   1.1  drochner 		sc->sc_ntbuf = 2;
    208   1.1  drochner 		break;
    209   1.1  drochner 	case 32768:
    210   1.1  drochner 		sc->sc_nrbuf = 16;
    211   1.1  drochner 		sc->sc_ntbuf = 4;
    212   1.1  drochner 		break;
    213   1.1  drochner 	case 65536:
    214   1.1  drochner 		sc->sc_nrbuf = 32;
    215   1.1  drochner 		sc->sc_ntbuf = 8;
    216   1.1  drochner 		break;
    217   1.1  drochner 	case 131072:
    218   1.1  drochner 		sc->sc_nrbuf = 64;
    219   1.1  drochner 		sc->sc_ntbuf = 16;
    220   1.4       leo 		break;
    221   1.4       leo 	case 262144:
    222   1.4       leo 		sc->sc_nrbuf = 128;
    223   1.4       leo 		sc->sc_ntbuf = 32;
    224   1.1  drochner 		break;
    225   1.1  drochner 	default:
    226  1.18  jdolecek 		/* weird memory size; cope with it */
    227  1.18  jdolecek 		nbuf = sc->sc_memsize / LEBLEN;
    228  1.18  jdolecek 		sc->sc_ntbuf = nbuf / 5;
    229  1.18  jdolecek 		sc->sc_nrbuf = nbuf - sc->sc_ntbuf;
    230   1.1  drochner 	}
    231   1.1  drochner 
    232  1.40   tsutsui 	aprint_normal(": address %s\n", ether_sprintf(sc->sc_enaddr));
    233  1.40   tsutsui 	aprint_normal_dev(sc->sc_dev,
    234  1.40   tsutsui 	    "%d receive buffers, %d transmit buffers\n",
    235  1.40   tsutsui 	    sc->sc_nrbuf, sc->sc_ntbuf);
    236  1.10    simonb 
    237  1.20  jdolecek 	/* Make sure the chip is stopped. */
    238  1.20  jdolecek 	lance_stop(ifp, 0);
    239  1.20  jdolecek 
    240  1.14    bouyer 	/* claim 802.1q capability */
    241  1.14    bouyer 	sc->sc_ethercom.ec_capabilities |= ETHERCAP_VLAN_MTU;
    242  1.10    simonb 	/* Attach the interface. */
    243  1.10    simonb 	if_attach(ifp);
    244  1.10    simonb 	ether_ifattach(ifp, sc->sc_enaddr);
    245   1.1  drochner 
    246  1.43   tsutsui 	if (pmf_device_register1(sc->sc_dev, NULL, NULL, lance_shutdown))
    247  1.43   tsutsui 		pmf_class_network_register(sc->sc_dev, ifp);
    248  1.43   tsutsui 	else
    249  1.43   tsutsui 		aprint_error_dev(sc->sc_dev,
    250  1.43   tsutsui 		    "couldn't establish power handler\n");
    251  1.43   tsutsui 
    252   1.1  drochner 	sc->sc_rbufaddr = malloc(sc->sc_nrbuf * sizeof(int), M_DEVBUF,
    253   1.1  drochner 					M_WAITOK);
    254   1.1  drochner 	sc->sc_tbufaddr = malloc(sc->sc_ntbuf * sizeof(int), M_DEVBUF,
    255   1.1  drochner 					M_WAITOK);
    256   1.1  drochner 
    257  1.40   tsutsui 	rnd_attach_source(&sc->rnd_source, device_xname(sc->sc_dev),
    258  1.47       tls 			  RND_TYPE_NET, RND_FLAG_DEFAULT);
    259   1.1  drochner }
    260   1.1  drochner 
    261   1.1  drochner void
    262  1.40   tsutsui lance_reset(struct lance_softc *sc)
    263   1.1  drochner {
    264   1.1  drochner 	int s;
    265   1.1  drochner 
    266   1.2   mycroft 	s = splnet();
    267  1.20  jdolecek 	lance_init(&sc->sc_ethercom.ec_if);
    268   1.1  drochner 	splx(s);
    269   1.1  drochner }
    270   1.1  drochner 
    271   1.1  drochner void
    272  1.37  christos lance_stop(struct ifnet *ifp, int disable)
    273   1.1  drochner {
    274  1.20  jdolecek 	struct lance_softc *sc = ifp->if_softc;
    275   1.1  drochner 
    276   1.1  drochner 	(*sc->sc_wrcsr)(sc, LE_CSR0, LE_C0_STOP);
    277   1.1  drochner }
    278   1.1  drochner 
    279   1.1  drochner /*
    280   1.1  drochner  * Initialization of interface; set up initialization block
    281   1.1  drochner  * and transmit/receive descriptor rings.
    282   1.1  drochner  */
    283  1.20  jdolecek int
    284  1.40   tsutsui lance_init(struct ifnet *ifp)
    285   1.1  drochner {
    286  1.20  jdolecek 	struct lance_softc *sc = ifp->if_softc;
    287  1.11  augustss 	int timo;
    288   1.1  drochner 	u_long a;
    289   1.1  drochner 
    290   1.1  drochner 	(*sc->sc_wrcsr)(sc, LE_CSR0, LE_C0_STOP);
    291   1.1  drochner 	DELAY(100);
    292   1.1  drochner 
    293   1.1  drochner 	/* Newer LANCE chips have a reset register */
    294   1.1  drochner 	if (sc->sc_hwreset)
    295   1.1  drochner 		(*sc->sc_hwreset)(sc);
    296   1.1  drochner 
    297   1.1  drochner 	/* Set the correct byte swapping mode, etc. */
    298   1.1  drochner 	(*sc->sc_wrcsr)(sc, LE_CSR3, sc->sc_conf3);
    299   1.1  drochner 
    300   1.1  drochner 	/* Set up LANCE init block. */
    301   1.1  drochner 	(*sc->sc_meminit)(sc);
    302   1.1  drochner 
    303   1.1  drochner 	/* Give LANCE the physical address of its init block. */
    304   1.1  drochner 	a = sc->sc_addr + LE_INITADDR(sc);
    305   1.1  drochner 	(*sc->sc_wrcsr)(sc, LE_CSR1, a);
    306   1.1  drochner 	(*sc->sc_wrcsr)(sc, LE_CSR2, a >> 16);
    307   1.1  drochner 
    308   1.1  drochner 	/* Try to initialize the LANCE. */
    309   1.1  drochner 	DELAY(100);
    310   1.1  drochner 	(*sc->sc_wrcsr)(sc, LE_CSR0, LE_C0_INIT);
    311   1.1  drochner 
    312   1.1  drochner 	/* Wait for initialization to finish. */
    313   1.1  drochner 	for (timo = 100000; timo; timo--)
    314   1.1  drochner 		if ((*sc->sc_rdcsr)(sc, LE_CSR0) & LE_C0_IDON)
    315   1.1  drochner 			break;
    316   1.1  drochner 
    317   1.1  drochner 	if ((*sc->sc_rdcsr)(sc, LE_CSR0) & LE_C0_IDON) {
    318   1.1  drochner 		/* Start the LANCE. */
    319  1.28        pk 		(*sc->sc_wrcsr)(sc, LE_CSR0, LE_C0_INEA | LE_C0_STRT);
    320   1.1  drochner 		ifp->if_flags |= IFF_RUNNING;
    321   1.1  drochner 		ifp->if_flags &= ~IFF_OACTIVE;
    322   1.1  drochner 		ifp->if_timer = 0;
    323   1.1  drochner 		(*sc->sc_start)(ifp);
    324   1.1  drochner 	} else
    325   1.1  drochner 		printf("%s: controller failed to initialize\n",
    326  1.40   tsutsui 			device_xname(sc->sc_dev));
    327   1.1  drochner 	if (sc->sc_hwinit)
    328   1.1  drochner 		(*sc->sc_hwinit)(sc);
    329  1.20  jdolecek 
    330  1.20  jdolecek 	return (0);
    331   1.1  drochner }
    332   1.1  drochner 
    333   1.1  drochner /*
    334   1.1  drochner  * Routine to copy from mbuf chain to transmit buffer in
    335   1.1  drochner  * network buffer memory.
    336   1.1  drochner  */
    337   1.1  drochner int
    338  1.40   tsutsui lance_put(struct lance_softc *sc, int boff, struct mbuf *m)
    339   1.1  drochner {
    340  1.11  augustss 	struct mbuf *n;
    341  1.11  augustss 	int len, tlen = 0;
    342   1.1  drochner 
    343   1.1  drochner 	for (; m; m = n) {
    344   1.1  drochner 		len = m->m_len;
    345   1.1  drochner 		if (len == 0) {
    346   1.1  drochner 			MFREE(m, n);
    347   1.1  drochner 			continue;
    348   1.1  drochner 		}
    349  1.38  christos 		(*sc->sc_copytobuf)(sc, mtod(m, void *), boff, len);
    350   1.1  drochner 		boff += len;
    351   1.1  drochner 		tlen += len;
    352   1.1  drochner 		MFREE(m, n);
    353   1.1  drochner 	}
    354   1.1  drochner 	if (tlen < LEMINSIZE) {
    355   1.1  drochner 		(*sc->sc_zerobuf)(sc, boff, LEMINSIZE - tlen);
    356   1.1  drochner 		tlen = LEMINSIZE;
    357   1.1  drochner 	}
    358   1.1  drochner 	return (tlen);
    359   1.1  drochner }
    360   1.1  drochner 
    361   1.1  drochner /*
    362   1.1  drochner  * Pull data off an interface.
    363   1.1  drochner  * Len is length of data, with local net header stripped.
    364   1.1  drochner  * We copy the data into mbufs.  When full cluster sized units are present
    365   1.1  drochner  * we copy into clusters.
    366   1.1  drochner  */
    367   1.1  drochner integrate struct mbuf *
    368  1.40   tsutsui lance_get(struct lance_softc *sc, int boff, int totlen)
    369   1.1  drochner {
    370   1.5   mycroft 	struct mbuf *m, *m0, *newm;
    371   1.1  drochner 	int len;
    372   1.1  drochner 
    373   1.5   mycroft 	MGETHDR(m0, M_DONTWAIT, MT_DATA);
    374   1.5   mycroft 	if (m0 == 0)
    375   1.1  drochner 		return (0);
    376  1.20  jdolecek 	m0->m_pkthdr.rcvif = &sc->sc_ethercom.ec_if;
    377   1.5   mycroft 	m0->m_pkthdr.len = totlen;
    378   1.1  drochner 	len = MHLEN;
    379   1.5   mycroft 	m = m0;
    380   1.1  drochner 
    381   1.1  drochner 	while (totlen > 0) {
    382   1.1  drochner 		if (totlen >= MINCLSIZE) {
    383   1.1  drochner 			MCLGET(m, M_DONTWAIT);
    384   1.5   mycroft 			if ((m->m_flags & M_EXT) == 0)
    385   1.5   mycroft 				goto bad;
    386   1.1  drochner 			len = MCLBYTES;
    387   1.1  drochner 		}
    388   1.5   mycroft 
    389   1.5   mycroft 		if (m == m0) {
    390  1.38  christos 			char *newdata = (char *)
    391   1.5   mycroft 			    ALIGN(m->m_data + sizeof(struct ether_header)) -
    392   1.5   mycroft 			    sizeof(struct ether_header);
    393   1.5   mycroft 			len -= newdata - m->m_data;
    394   1.5   mycroft 			m->m_data = newdata;
    395   1.1  drochner 		}
    396   1.5   mycroft 
    397   1.1  drochner 		m->m_len = len = min(totlen, len);
    398  1.38  christos 		(*sc->sc_copyfrombuf)(sc, mtod(m, void *), boff, len);
    399   1.1  drochner 		boff += len;
    400   1.5   mycroft 
    401   1.1  drochner 		totlen -= len;
    402   1.5   mycroft 		if (totlen > 0) {
    403   1.5   mycroft 			MGET(newm, M_DONTWAIT, MT_DATA);
    404   1.5   mycroft 			if (newm == 0)
    405   1.5   mycroft 				goto bad;
    406   1.5   mycroft 			len = MLEN;
    407   1.5   mycroft 			m = m->m_next = newm;
    408   1.5   mycroft 		}
    409   1.1  drochner 	}
    410   1.1  drochner 
    411   1.5   mycroft 	return (m0);
    412   1.5   mycroft 
    413   1.5   mycroft bad:
    414   1.5   mycroft 	m_freem(m0);
    415   1.5   mycroft 	return (0);
    416   1.1  drochner }
    417   1.1  drochner 
    418   1.1  drochner /*
    419   1.1  drochner  * Pass a packet to the higher levels.
    420   1.1  drochner  */
    421   1.1  drochner void
    422  1.40   tsutsui lance_read(struct lance_softc *sc, int boff, int len)
    423   1.1  drochner {
    424   1.1  drochner 	struct mbuf *m;
    425  1.20  jdolecek 	struct ifnet *ifp = &sc->sc_ethercom.ec_if;
    426  1.15   tsutsui 	struct ether_header *eh;
    427   1.1  drochner 
    428   1.1  drochner 	if (len <= sizeof(struct ether_header) ||
    429  1.14    bouyer 	    len > ((sc->sc_ethercom.ec_capenable & ETHERCAP_VLAN_MTU) ?
    430  1.14    bouyer 		ETHER_VLAN_ENCAP_LEN + ETHERMTU + sizeof(struct ether_header) :
    431  1.14    bouyer 		ETHERMTU + sizeof(struct ether_header))) {
    432   1.1  drochner #ifdef LEDEBUG
    433   1.1  drochner 		printf("%s: invalid packet size %d; dropping\n",
    434  1.40   tsutsui 		    device_xname(sc->sc_dev), len);
    435   1.1  drochner #endif
    436   1.1  drochner 		ifp->if_ierrors++;
    437   1.1  drochner 		return;
    438   1.1  drochner 	}
    439   1.1  drochner 
    440   1.1  drochner 	/* Pull packet off interface. */
    441   1.1  drochner 	m = lance_get(sc, boff, len);
    442   1.1  drochner 	if (m == 0) {
    443   1.1  drochner 		ifp->if_ierrors++;
    444   1.1  drochner 		return;
    445   1.1  drochner 	}
    446   1.1  drochner 
    447   1.1  drochner 	ifp->if_ipackets++;
    448   1.1  drochner 
    449  1.27    itojun 	eh = mtod(m, struct ether_header *);
    450   1.1  drochner 
    451   1.1  drochner #ifdef LANCE_REVC_BUG
    452   1.1  drochner 	/*
    453   1.1  drochner 	 * The old LANCE (Rev. C) chips have a bug which causes
    454   1.1  drochner 	 * garbage to be inserted in front of the received packet.
    455   1.1  drochner 	 * The work-around is to ignore packets with an invalid
    456   1.1  drochner 	 * destination address (garbage will usually not match).
    457   1.1  drochner 	 * Of course, this precludes multicast support...
    458   1.1  drochner 	 */
    459   1.1  drochner 	if (ETHER_CMP(eh->ether_dhost, sc->sc_enaddr) &&
    460   1.1  drochner 	    ETHER_CMP(eh->ether_dhost, bcast_enaddr)) {
    461   1.1  drochner 		m_freem(m);
    462   1.1  drochner 		return;
    463   1.1  drochner 	}
    464  1.27    itojun #endif
    465  1.27    itojun 
    466  1.27    itojun 	/*
    467  1.27    itojun 	 * Some lance device does not present IFF_SIMPLEX behavior on multicast
    468  1.27    itojun 	 * packets.  Make sure to drop it if it is from ourselves.
    469  1.27    itojun 	 */
    470  1.27    itojun 	if (!ETHER_CMP(eh->ether_shost, sc->sc_enaddr)) {
    471  1.27    itojun 		m_freem(m);
    472  1.27    itojun 		return;
    473  1.27    itojun 	}
    474  1.27    itojun 
    475  1.27    itojun 	/*
    476  1.27    itojun 	 * Check if there's a BPF listener on this interface.
    477  1.27    itojun 	 * If so, hand off the raw packet to BPF.
    478  1.27    itojun 	 */
    479  1.45     joerg 	bpf_mtap(ifp, m);
    480   1.1  drochner 
    481   1.9   thorpej 	/* Pass the packet up. */
    482   1.9   thorpej 	(*ifp->if_input)(ifp, m);
    483   1.1  drochner }
    484   1.1  drochner 
    485   1.1  drochner #undef	ifp
    486   1.1  drochner 
    487   1.1  drochner void
    488  1.40   tsutsui lance_watchdog(struct ifnet *ifp)
    489   1.1  drochner {
    490   1.1  drochner 	struct lance_softc *sc = ifp->if_softc;
    491   1.1  drochner 
    492  1.40   tsutsui 	log(LOG_ERR, "%s: device timeout\n", device_xname(sc->sc_dev));
    493   1.1  drochner 	++ifp->if_oerrors;
    494   1.1  drochner 
    495   1.1  drochner 	lance_reset(sc);
    496   1.1  drochner }
    497   1.1  drochner 
    498   1.1  drochner int
    499  1.40   tsutsui lance_mediachange(struct ifnet *ifp)
    500   1.1  drochner {
    501   1.1  drochner 	struct lance_softc *sc = ifp->if_softc;
    502   1.1  drochner 
    503   1.1  drochner 	if (sc->sc_mediachange)
    504   1.1  drochner 		return ((*sc->sc_mediachange)(sc));
    505   1.8   thorpej 	return (0);
    506   1.1  drochner }
    507   1.1  drochner 
    508   1.1  drochner void
    509  1.40   tsutsui lance_mediastatus(struct ifnet *ifp, struct ifmediareq *ifmr)
    510   1.1  drochner {
    511   1.1  drochner 	struct lance_softc *sc = ifp->if_softc;
    512   1.1  drochner 
    513   1.1  drochner 	if ((ifp->if_flags & IFF_UP) == 0)
    514   1.1  drochner 		return;
    515   1.1  drochner 
    516   1.1  drochner 	ifmr->ifm_status = IFM_AVALID;
    517   1.1  drochner 	if (sc->sc_havecarrier)
    518   1.1  drochner 		ifmr->ifm_status |= IFM_ACTIVE;
    519   1.1  drochner 
    520   1.1  drochner 	if (sc->sc_mediastatus)
    521   1.1  drochner 		(*sc->sc_mediastatus)(sc, ifmr);
    522   1.1  drochner }
    523   1.1  drochner 
    524   1.1  drochner /*
    525   1.1  drochner  * Process an ioctl request.
    526   1.1  drochner  */
    527   1.1  drochner int
    528  1.40   tsutsui lance_ioctl(struct ifnet *ifp, u_long cmd, void *data)
    529   1.1  drochner {
    530  1.11  augustss 	struct lance_softc *sc = ifp->if_softc;
    531   1.1  drochner 	struct ifreq *ifr = (struct ifreq *)data;
    532   1.1  drochner 	int s, error = 0;
    533   1.1  drochner 
    534   1.2   mycroft 	s = splnet();
    535   1.1  drochner 
    536   1.1  drochner 	switch (cmd) {
    537  1.42    dyoung 	case SIOCGIFMEDIA:
    538  1.42    dyoung 	case SIOCSIFMEDIA:
    539  1.42    dyoung 		error = ifmedia_ioctl(ifp, ifr, &sc->sc_media, cmd);
    540   1.1  drochner 		break;
    541  1.42    dyoung 	default:
    542  1.42    dyoung 		if ((error = ether_ioctl(ifp, cmd, data)) != ENETRESET)
    543  1.42    dyoung 			break;
    544  1.42    dyoung 		error = 0;
    545  1.42    dyoung 		if (cmd != SIOCADDMULTI && cmd != SIOCDELMULTI)
    546  1.42    dyoung 			break;
    547  1.42    dyoung 		if (ifp->if_flags & IFF_RUNNING) {
    548   1.1  drochner 			/*
    549   1.1  drochner 			 * Multicast list has changed; set the hardware filter
    550   1.1  drochner 			 * accordingly.
    551   1.1  drochner 			 */
    552  1.42    dyoung 			lance_reset(sc);
    553   1.1  drochner 		}
    554   1.1  drochner 		break;
    555   1.1  drochner 
    556   1.1  drochner 	}
    557   1.1  drochner 
    558   1.1  drochner 	splx(s);
    559   1.1  drochner 	return (error);
    560   1.1  drochner }
    561   1.1  drochner 
    562  1.43   tsutsui hide bool
    563  1.43   tsutsui lance_shutdown(device_t self, int howto)
    564   1.1  drochner {
    565  1.43   tsutsui 	struct lance_softc *sc = device_private(self);
    566  1.43   tsutsui 	struct ifnet *ifp = &sc->sc_ethercom.ec_if;
    567  1.43   tsutsui 
    568  1.43   tsutsui 	lance_stop(ifp, 0);
    569   1.1  drochner 
    570  1.43   tsutsui 	return true;
    571   1.1  drochner }
    572   1.1  drochner 
    573   1.1  drochner /*
    574   1.1  drochner  * Set up the logical address filter.
    575   1.1  drochner  */
    576   1.1  drochner void
    577  1.40   tsutsui lance_setladrf(struct ethercom *ac, uint16_t *af)
    578   1.1  drochner {
    579   1.1  drochner 	struct ifnet *ifp = &ac->ec_if;
    580   1.1  drochner 	struct ether_multi *enm;
    581  1.40   tsutsui 	uint32_t crc;
    582   1.1  drochner 	struct ether_multistep step;
    583   1.1  drochner 
    584   1.1  drochner 	/*
    585   1.1  drochner 	 * Set up multicast address filter by passing all multicast addresses
    586   1.1  drochner 	 * through a crc generator, and then using the high order 6 bits as an
    587   1.1  drochner 	 * index into the 64 bit logical address filter.  The high order bit
    588   1.1  drochner 	 * selects the word, while the rest of the bits select the bit within
    589   1.1  drochner 	 * the word.
    590   1.1  drochner 	 */
    591   1.1  drochner 
    592   1.1  drochner 	if (ifp->if_flags & IFF_PROMISC)
    593   1.1  drochner 		goto allmulti;
    594   1.1  drochner 
    595   1.1  drochner 	af[0] = af[1] = af[2] = af[3] = 0x0000;
    596   1.1  drochner 	ETHER_FIRST_MULTI(step, ac, enm);
    597   1.1  drochner 	while (enm != NULL) {
    598   1.1  drochner 		if (ETHER_CMP(enm->enm_addrlo, enm->enm_addrhi)) {
    599   1.1  drochner 			/*
    600   1.1  drochner 			 * We must listen to a range of multicast addresses.
    601   1.1  drochner 			 * For now, just accept all multicasts, rather than
    602   1.1  drochner 			 * trying to set only those filter bits needed to match
    603   1.1  drochner 			 * the range.  (At this time, the only use of address
    604   1.1  drochner 			 * ranges is for IP multicast routing, for which the
    605   1.1  drochner 			 * range is big enough to require all bits set.)
    606   1.1  drochner 			 */
    607   1.1  drochner 			goto allmulti;
    608   1.1  drochner 		}
    609   1.1  drochner 
    610  1.12   thorpej 		crc = ether_crc32_le(enm->enm_addrlo, ETHER_ADDR_LEN);
    611  1.12   thorpej 
    612   1.1  drochner 		/* Just want the 6 most significant bits. */
    613   1.1  drochner 		crc >>= 26;
    614   1.1  drochner 
    615   1.1  drochner 		/* Set the corresponding bit in the filter. */
    616   1.1  drochner 		af[crc >> 4] |= 1 << (crc & 0xf);
    617   1.1  drochner 
    618   1.1  drochner 		ETHER_NEXT_MULTI(step, enm);
    619   1.1  drochner 	}
    620   1.1  drochner 	ifp->if_flags &= ~IFF_ALLMULTI;
    621   1.1  drochner 	return;
    622   1.1  drochner 
    623   1.1  drochner allmulti:
    624   1.1  drochner 	ifp->if_flags |= IFF_ALLMULTI;
    625   1.1  drochner 	af[0] = af[1] = af[2] = af[3] = 0xffff;
    626   1.1  drochner }
    627   1.1  drochner 
    628   1.1  drochner /*
    629   1.1  drochner  * Routines for accessing the transmit and receive buffers.
    630   1.1  drochner  * The various CPU and adapter configurations supported by this
    631   1.1  drochner  * driver require three different access methods for buffers
    632   1.1  drochner  * and descriptors:
    633   1.1  drochner  *	(1) contig (contiguous data; no padding),
    634   1.1  drochner  *	(2) gap2 (two bytes of data followed by two bytes of padding),
    635   1.1  drochner  *	(3) gap16 (16 bytes of data followed by 16 bytes of padding).
    636   1.1  drochner  */
    637   1.1  drochner 
    638   1.1  drochner /*
    639   1.1  drochner  * contig: contiguous data with no padding.
    640   1.1  drochner  *
    641   1.1  drochner  * Buffers may have any alignment.
    642   1.1  drochner  */
    643   1.1  drochner 
    644   1.1  drochner void
    645  1.40   tsutsui lance_copytobuf_contig(struct lance_softc *sc, void *from, int boff, int len)
    646   1.1  drochner {
    647  1.40   tsutsui 	uint8_t *buf = sc->sc_mem;
    648   1.1  drochner 
    649   1.1  drochner 	/*
    650  1.24   thorpej 	 * Just call memcpy() to do the work.
    651   1.1  drochner 	 */
    652  1.24   thorpej 	memcpy(buf + boff, from, len);
    653   1.1  drochner }
    654   1.1  drochner 
    655   1.1  drochner void
    656  1.40   tsutsui lance_copyfrombuf_contig(struct lance_softc *sc, void *to, int boff, int len)
    657   1.1  drochner {
    658  1.40   tsutsui 	uint8_t *buf = sc->sc_mem;
    659   1.1  drochner 
    660   1.1  drochner 	/*
    661  1.24   thorpej 	 * Just call memcpy() to do the work.
    662   1.1  drochner 	 */
    663  1.24   thorpej 	memcpy(to, buf + boff, len);
    664   1.1  drochner }
    665   1.1  drochner 
    666   1.1  drochner void
    667  1.40   tsutsui lance_zerobuf_contig(struct lance_softc *sc, int boff, int len)
    668   1.1  drochner {
    669  1.40   tsutsui 	uint8_t *buf = sc->sc_mem;
    670   1.1  drochner 
    671   1.1  drochner 	/*
    672  1.25   thorpej 	 * Just let memset() do the work
    673   1.1  drochner 	 */
    674  1.25   thorpej 	memset(buf + boff, 0, len);
    675   1.1  drochner }
    676   1.1  drochner 
    677   1.1  drochner #if 0
    678   1.1  drochner /*
    679   1.1  drochner  * Examples only; duplicate these and tweak (if necessary) in
    680   1.1  drochner  * machine-specific front-ends.
    681   1.1  drochner  */
    682   1.1  drochner 
    683   1.1  drochner /*
    684   1.1  drochner  * gap2: two bytes of data followed by two bytes of pad.
    685   1.1  drochner  *
    686   1.1  drochner  * Buffers must be 4-byte aligned.  The code doesn't worry about
    687   1.1  drochner  * doing an extra byte.
    688   1.1  drochner  */
    689   1.1  drochner 
    690   1.1  drochner void
    691  1.40   tsutsui lance_copytobuf_gap2(struct lance_softc *sc, void *fromv, int boff, int len)
    692   1.1  drochner {
    693  1.38  christos 	volatile void *buf = sc->sc_mem;
    694  1.38  christos 	void *from = fromv;
    695  1.40   tsutsui 	volatile uint16_t *bptr;
    696   1.1  drochner 
    697   1.1  drochner 	if (boff & 0x1) {
    698   1.1  drochner 		/* handle unaligned first byte */
    699  1.40   tsutsui 		bptr = ((volatile uint16_t *)buf) + (boff - 1);
    700   1.1  drochner 		*bptr = (*from++ << 8) | (*bptr & 0xff);
    701   1.1  drochner 		bptr += 2;
    702   1.1  drochner 		len--;
    703   1.1  drochner 	} else
    704  1.40   tsutsui 		bptr = ((volatile uint16_t *)buf) + boff;
    705   1.1  drochner 	while (len > 1) {
    706   1.1  drochner 		*bptr = (from[1] << 8) | (from[0] & 0xff);
    707   1.1  drochner 		bptr += 2;
    708   1.1  drochner 		from += 2;
    709   1.1  drochner 		len -= 2;
    710   1.1  drochner 	}
    711   1.1  drochner 	if (len == 1)
    712  1.40   tsutsui 		*bptr = (uint16_t)*from;
    713   1.1  drochner }
    714   1.1  drochner 
    715   1.1  drochner void
    716  1.40   tsutsui lance_copyfrombuf_gap2(struct lance_softc *sc, void *tov, int boff, int len)
    717   1.1  drochner {
    718  1.38  christos 	volatile void *buf = sc->sc_mem;
    719  1.38  christos 	void *to = tov;
    720  1.40   tsutsui 	volatile uint16_t *bptr;
    721  1.40   tsutsui 	uint16_t tmp;
    722   1.1  drochner 
    723   1.1  drochner 	if (boff & 0x1) {
    724   1.1  drochner 		/* handle unaligned first byte */
    725  1.40   tsutsui 		bptr = ((volatile uint16_t *)buf) + (boff - 1);
    726   1.1  drochner 		*to++ = (*bptr >> 8) & 0xff;
    727   1.1  drochner 		bptr += 2;
    728   1.1  drochner 		len--;
    729   1.1  drochner 	} else
    730  1.40   tsutsui 		bptr = ((volatile uint16_t *)buf) + boff;
    731   1.1  drochner 	while (len > 1) {
    732   1.1  drochner 		tmp = *bptr;
    733   1.1  drochner 		*to++ = tmp & 0xff;
    734   1.1  drochner 		*to++ = (tmp >> 8) & 0xff;
    735   1.1  drochner 		bptr += 2;
    736   1.1  drochner 		len -= 2;
    737   1.1  drochner 	}
    738   1.1  drochner 	if (len == 1)
    739   1.1  drochner 		*to = *bptr & 0xff;
    740   1.1  drochner }
    741   1.1  drochner 
    742   1.1  drochner void
    743  1.40   tsutsui lance_zerobuf_gap2(struct lance_softc *sc, int boff, int len)
    744   1.1  drochner {
    745  1.38  christos 	volatile void *buf = sc->sc_mem;
    746  1.40   tsutsui 	volatile uint16_t *bptr;
    747   1.1  drochner 
    748  1.40   tsutsui 	if ((unsigned int)boff & 0x1) {
    749  1.40   tsutsui 		bptr = ((volatile uint16_t *)buf) + (boff - 1);
    750   1.1  drochner 		*bptr &= 0xff;
    751   1.1  drochner 		bptr += 2;
    752   1.1  drochner 		len--;
    753   1.1  drochner 	} else
    754  1.40   tsutsui 		bptr = ((volatile uint16_t *)buf) + boff;
    755   1.1  drochner 	while (len > 0) {
    756   1.1  drochner 		*bptr = 0;
    757   1.1  drochner 		bptr += 2;
    758   1.1  drochner 		len -= 2;
    759   1.1  drochner 	}
    760   1.1  drochner }
    761   1.1  drochner 
    762   1.1  drochner /*
    763   1.1  drochner  * gap16: 16 bytes of data followed by 16 bytes of pad.
    764   1.1  drochner  *
    765   1.1  drochner  * Buffers must be 32-byte aligned.
    766   1.1  drochner  */
    767   1.1  drochner 
    768   1.1  drochner void
    769  1.40   tsutsui lance_copytobuf_gap16(struct lance_softc *sc, void *fromv, int boff, int len)
    770   1.1  drochner {
    771  1.40   tsutsui 	volatile uint8_t *buf = sc->sc_mem;
    772  1.38  christos 	void *from = fromv;
    773  1.40   tsutsui 	uint8_t *bptr;
    774  1.11  augustss 	int xfer;
    775   1.1  drochner 
    776   1.1  drochner 	bptr = buf + ((boff << 1) & ~0x1f);
    777   1.1  drochner 	boff &= 0xf;
    778   1.1  drochner 	xfer = min(len, 16 - boff);
    779   1.1  drochner 	while (len > 0) {
    780  1.24   thorpej 		memcpy(bptr + boff, from, xfer);
    781   1.1  drochner 		from += xfer;
    782   1.1  drochner 		bptr += 32;
    783   1.1  drochner 		boff = 0;
    784   1.1  drochner 		len -= xfer;
    785   1.1  drochner 		xfer = min(len, 16);
    786   1.1  drochner 	}
    787   1.1  drochner }
    788   1.1  drochner 
    789   1.1  drochner void
    790  1.40   tsutsui lance_copyfrombuf_gap16(struct lance_softc *sc, void *tov, int boff, int len)
    791   1.1  drochner {
    792  1.40   tsutsui 	volatile uint8_t *buf = sc->sc_mem;
    793  1.38  christos 	void *to = tov;
    794  1.40   tsutsui 	uint8_t *bptr;
    795  1.11  augustss 	int xfer;
    796   1.1  drochner 
    797   1.1  drochner 	bptr = buf + ((boff << 1) & ~0x1f);
    798   1.1  drochner 	boff &= 0xf;
    799   1.1  drochner 	xfer = min(len, 16 - boff);
    800   1.1  drochner 	while (len > 0) {
    801  1.24   thorpej 		memcpy(to, bptr + boff, xfer);
    802   1.1  drochner 		to += xfer;
    803   1.1  drochner 		bptr += 32;
    804   1.1  drochner 		boff = 0;
    805   1.1  drochner 		len -= xfer;
    806   1.1  drochner 		xfer = min(len, 16);
    807   1.1  drochner 	}
    808   1.1  drochner }
    809   1.1  drochner 
    810   1.1  drochner void
    811  1.40   tsutsui lance_zerobuf_gap16(struct lance_softc *sc, int boff, int len)
    812   1.1  drochner {
    813  1.40   tsutsui 	volatile uint8_t *buf = sc->sc_mem;
    814  1.40   tsutsui 	uint8_t *bptr;
    815  1.11  augustss 	int xfer;
    816   1.1  drochner 
    817   1.1  drochner 	bptr = buf + ((boff << 1) & ~0x1f);
    818   1.1  drochner 	boff &= 0xf;
    819   1.1  drochner 	xfer = min(len, 16 - boff);
    820   1.1  drochner 	while (len > 0) {
    821  1.25   thorpej 		memset(bptr + boff, 0, xfer);
    822   1.1  drochner 		bptr += 32;
    823   1.1  drochner 		boff = 0;
    824   1.1  drochner 		len -= xfer;
    825   1.1  drochner 		xfer = min(len, 16);
    826   1.1  drochner 	}
    827   1.1  drochner }
    828   1.1  drochner #endif /* Example only */
    829