Home | History | Annotate | Line # | Download | only in usb
if_udav.c revision 1.59
      1  1.59   msaitoh /*	$NetBSD: if_udav.c,v 1.59 2019/05/28 07:41:50 msaitoh Exp $	*/
      2   1.1    itojun /*	$nabe: if_udav.c,v 1.3 2003/08/21 16:57:19 nabe Exp $	*/
      3  1.37       mrg 
      4   1.1    itojun /*
      5   1.1    itojun  * Copyright (c) 2003
      6   1.1    itojun  *     Shingo WATANABE <nabe (at) nabechan.org>.  All rights reserved.
      7   1.1    itojun  *
      8   1.1    itojun  * Redistribution and use in source and binary forms, with or without
      9   1.1    itojun  * modification, are permitted provided that the following conditions
     10   1.1    itojun  * are met:
     11   1.1    itojun  * 1. Redistributions of source code must retain the above copyright
     12   1.1    itojun  *    notice, this list of conditions and the following disclaimer.
     13   1.1    itojun  * 2. Redistributions in binary form must reproduce the above copyright
     14   1.1    itojun  *    notice, this list of conditions and the following disclaimer in the
     15   1.1    itojun  *    documentation and/or other materials provided with the distribution.
     16   1.2   tsutsui  * 3. Neither the name of the author nor the names of any co-contributors
     17   1.1    itojun  *    may be used to endorse or promote products derived from this software
     18   1.1    itojun  *    without specific prior written permission.
     19   1.1    itojun  *
     20   1.1    itojun  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
     21   1.1    itojun  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
     22   1.1    itojun  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
     23   1.1    itojun  * ARE DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
     24   1.1    itojun  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
     25   1.1    itojun  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
     26   1.1    itojun  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
     27   1.1    itojun  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
     28   1.1    itojun  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
     29   1.1    itojun  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
     30   1.1    itojun  * SUCH DAMAGE.
     31   1.1    itojun  *
     32   1.1    itojun  */
     33   1.1    itojun 
     34   1.1    itojun /*
     35   1.1    itojun  * DM9601(DAVICOM USB to Ethernet MAC Controller with Integrated 10/100 PHY)
     36   1.1    itojun  * The spec can be found at the following url.
     37   1.1    itojun  *   http://www.davicom.com.tw/big5/download/Data%20Sheet/DM9601-DS-F01-062202s.pdf
     38   1.1    itojun  */
     39   1.1    itojun 
     40   1.1    itojun /*
     41   1.1    itojun  * TODO:
     42   1.1    itojun  *	Interrupt Endpoint support
     43   1.1    itojun  *	External PHYs
     44   1.1    itojun  *	powerhook() support?
     45   1.1    itojun  */
     46   1.1    itojun 
     47   1.1    itojun #include <sys/cdefs.h>
     48  1.59   msaitoh __KERNEL_RCSID(0, "$NetBSD: if_udav.c,v 1.59 2019/05/28 07:41:50 msaitoh Exp $");
     49   1.1    itojun 
     50  1.40  christos #ifdef _KERNEL_OPT
     51   1.1    itojun #include "opt_inet.h"
     52  1.49     skrll #include "opt_usb.h"
     53  1.40  christos #endif
     54   1.1    itojun 
     55   1.1    itojun #include <sys/param.h>
     56   1.1    itojun #include <sys/systm.h>
     57  1.19        ad #include <sys/mutex.h>
     58   1.1    itojun #include <sys/mbuf.h>
     59   1.1    itojun #include <sys/kernel.h>
     60   1.1    itojun #include <sys/socket.h>
     61   1.1    itojun #include <sys/device.h>
     62  1.44  riastrad #include <sys/rndsource.h>
     63   1.1    itojun 
     64   1.1    itojun #include <net/if.h>
     65   1.1    itojun #include <net/if_arp.h>
     66   1.1    itojun #include <net/if_dl.h>
     67   1.1    itojun #include <net/if_media.h>
     68   1.1    itojun 
     69   1.1    itojun #include <net/bpf.h>
     70   1.1    itojun 
     71   1.1    itojun #include <net/if_ether.h>
     72   1.1    itojun #ifdef INET
     73   1.1    itojun #include <netinet/in.h>
     74   1.1    itojun #include <netinet/if_inarp.h>
     75   1.1    itojun #endif
     76   1.1    itojun 
     77   1.1    itojun #include <dev/mii/mii.h>
     78   1.1    itojun #include <dev/mii/miivar.h>
     79   1.1    itojun 
     80   1.1    itojun #include <dev/usb/usb.h>
     81   1.1    itojun #include <dev/usb/usbdi.h>
     82   1.1    itojun #include <dev/usb/usbdi_util.h>
     83   1.1    itojun #include <dev/usb/usbdevs.h>
     84   1.1    itojun 
     85   1.1    itojun #include <dev/usb/if_udavreg.h>
     86   1.1    itojun 
     87   1.1    itojun 
     88   1.1    itojun /* Function declarations */
     89  1.48   msaitoh int	udav_match(device_t, cfdata_t, void *);
     90  1.48   msaitoh void	udav_attach(device_t, device_t, void *);
     91  1.48   msaitoh int	udav_detach(device_t, int);
     92  1.48   msaitoh int	udav_activate(device_t, enum devact);
     93  1.57       mrg 
     94  1.48   msaitoh CFATTACH_DECL_NEW(udav, sizeof(struct udav_softc), udav_match, udav_attach,
     95  1.48   msaitoh     udav_detach, udav_activate);
     96   1.1    itojun 
     97   1.1    itojun Static int udav_openpipes(struct udav_softc *);
     98   1.1    itojun Static int udav_rx_list_init(struct udav_softc *);
     99   1.1    itojun Static int udav_tx_list_init(struct udav_softc *);
    100   1.1    itojun Static int udav_newbuf(struct udav_softc *, struct udav_chain *, struct mbuf *);
    101   1.1    itojun Static void udav_start(struct ifnet *);
    102   1.1    itojun Static int udav_send(struct udav_softc *, struct mbuf *, int);
    103  1.46     skrll Static void udav_txeof(struct usbd_xfer *, void *, usbd_status);
    104  1.46     skrll Static void udav_rxeof(struct usbd_xfer *, void *, usbd_status);
    105   1.1    itojun Static void udav_tick(void *);
    106   1.1    itojun Static void udav_tick_task(void *);
    107  1.16  christos Static int udav_ioctl(struct ifnet *, u_long, void *);
    108   1.1    itojun Static void udav_stop_task(struct udav_softc *);
    109   1.1    itojun Static void udav_stop(struct ifnet *, int);
    110   1.1    itojun Static void udav_watchdog(struct ifnet *);
    111   1.1    itojun Static int udav_ifmedia_change(struct ifnet *);
    112   1.1    itojun Static void udav_ifmedia_status(struct ifnet *, struct ifmediareq *);
    113   1.1    itojun Static void udav_lock_mii(struct udav_softc *);
    114   1.1    itojun Static void udav_unlock_mii(struct udav_softc *);
    115  1.56   msaitoh Static int udav_miibus_readreg(device_t, int, int, uint16_t *);
    116  1.56   msaitoh Static int udav_miibus_writereg(device_t, int, int, uint16_t);
    117  1.38      matt Static void udav_miibus_statchg(struct ifnet *);
    118   1.1    itojun Static int udav_init(struct ifnet *);
    119   1.1    itojun Static void udav_setmulti(struct udav_softc *);
    120   1.1    itojun Static void udav_reset(struct udav_softc *);
    121   1.1    itojun 
    122   1.1    itojun Static int udav_csr_read(struct udav_softc *, int, void *, int);
    123   1.1    itojun Static int udav_csr_write(struct udav_softc *, int, void *, int);
    124   1.1    itojun Static int udav_csr_read1(struct udav_softc *, int);
    125   1.1    itojun Static int udav_csr_write1(struct udav_softc *, int, unsigned char);
    126   1.1    itojun 
    127   1.1    itojun #if 0
    128   1.1    itojun Static int udav_mem_read(struct udav_softc *, int, void *, int);
    129   1.1    itojun Static int udav_mem_write(struct udav_softc *, int, void *, int);
    130   1.1    itojun Static int udav_mem_write1(struct udav_softc *, int, unsigned char);
    131   1.1    itojun #endif
    132   1.1    itojun 
    133   1.1    itojun /* Macros */
    134   1.1    itojun #ifdef UDAV_DEBUG
    135  1.31    dyoung #define DPRINTF(x)	if (udavdebug) printf x
    136  1.58   msaitoh #define DPRINTFN(n, x)	if (udavdebug >= (n)) printf x
    137   1.1    itojun int udavdebug = 0;
    138   1.1    itojun #else
    139   1.1    itojun #define DPRINTF(x)
    140  1.58   msaitoh #define DPRINTFN(n, x)
    141   1.1    itojun #endif
    142   1.1    itojun 
    143   1.1    itojun #define	UDAV_SETBIT(sc, reg, x)	\
    144   1.1    itojun 	udav_csr_write1(sc, reg, udav_csr_read1(sc, reg) | (x))
    145   1.1    itojun 
    146   1.1    itojun #define	UDAV_CLRBIT(sc, reg, x)	\
    147   1.1    itojun 	udav_csr_write1(sc, reg, udav_csr_read1(sc, reg) & ~(x))
    148   1.1    itojun 
    149   1.1    itojun static const struct udav_type {
    150   1.1    itojun 	struct usb_devno udav_dev;
    151  1.46     skrll 	uint16_t udav_flags;
    152   1.1    itojun #define UDAV_EXT_PHY	0x0001
    153  1.42  jakllsch #define UDAV_NO_PHY	0x0002
    154   1.1    itojun } udav_devs [] = {
    155   1.1    itojun 	/* Corega USB-TXC */
    156   1.1    itojun 	{{ USB_VENDOR_COREGA, USB_PRODUCT_COREGA_FETHER_USB_TXC }, 0},
    157  1.18   xtraeme 	/* ShanTou ST268 USB NIC */
    158  1.18   xtraeme 	{{ USB_VENDOR_SHANTOU, USB_PRODUCT_SHANTOU_ST268_USB_NIC }, 0},
    159  1.22  drochner 	/* ShanTou ADM8515 */
    160  1.22  drochner 	{{ USB_VENDOR_SHANTOU, USB_PRODUCT_SHANTOU_ADM8515 }, 0},
    161  1.30  jmcneill 	/* SUNRISING SR9600 */
    162  1.30  jmcneill 	{{ USB_VENDOR_SUNRISING, USB_PRODUCT_SUNRISING_SR9600 }, 0 },
    163  1.42  jakllsch 	/* SUNRISING QF9700 */
    164  1.42  jakllsch 	{{ USB_VENDOR_SUNRISING, USB_PRODUCT_SUNRISING_QF9700 }, UDAV_NO_PHY },
    165  1.35   mbalmer 	/* QUAN DM9601 */
    166  1.35   mbalmer 	{{USB_VENDOR_QUAN, USB_PRODUCT_QUAN_DM9601 }, 0},
    167   1.1    itojun #if 0
    168   1.1    itojun 	/* DAVICOM DM9601 Generic? */
    169   1.1    itojun 	/*  XXX: The following ids was obtained from the data sheet. */
    170   1.1    itojun 	{{ 0x0a46, 0x9601 }, 0},
    171   1.1    itojun #endif
    172   1.1    itojun };
    173   1.7  christos #define udav_lookup(v, p) ((const struct udav_type *)usb_lookup(udav_devs, v, p))
    174   1.1    itojun 
    175   1.1    itojun 
    176   1.1    itojun /* Probe */
    177  1.40  christos int
    178  1.31    dyoung udav_match(device_t parent, cfdata_t match, void *aux)
    179   1.1    itojun {
    180  1.31    dyoung 	struct usb_attach_arg *uaa = aux;
    181   1.1    itojun 
    182  1.46     skrll 	return udav_lookup(uaa->uaa_vendor, uaa->uaa_product) != NULL ?
    183  1.46     skrll 		UMATCH_VENDOR_PRODUCT : UMATCH_NONE;
    184   1.1    itojun }
    185   1.1    itojun 
    186   1.1    itojun /* Attach */
    187  1.40  christos void
    188  1.31    dyoung udav_attach(device_t parent, device_t self, void *aux)
    189   1.1    itojun {
    190  1.31    dyoung 	struct udav_softc *sc = device_private(self);
    191  1.31    dyoung 	struct usb_attach_arg *uaa = aux;
    192  1.46     skrll 	struct usbd_device *dev = uaa->uaa_device;
    193  1.46     skrll 	struct usbd_interface *iface;
    194   1.1    itojun 	usbd_status err;
    195   1.1    itojun 	usb_interface_descriptor_t *id;
    196   1.1    itojun 	usb_endpoint_descriptor_t *ed;
    197   1.6  augustss 	char *devinfop;
    198   1.1    itojun 	struct ifnet *ifp;
    199   1.1    itojun 	struct mii_data *mii;
    200   1.1    itojun 	u_char eaddr[ETHER_ADDR_LEN];
    201   1.1    itojun 	int i, s;
    202   1.1    itojun 
    203  1.24      cube 	sc->sc_dev = self;
    204  1.24      cube 
    205  1.26    plunky 	aprint_naive("\n");
    206  1.26    plunky 	aprint_normal("\n");
    207  1.26    plunky 
    208   1.6  augustss 	devinfop = usbd_devinfo_alloc(dev, 0);
    209  1.24      cube 	aprint_normal_dev(self, "%s\n", devinfop);
    210   1.6  augustss 	usbd_devinfo_free(devinfop);
    211   1.1    itojun 
    212   1.1    itojun 	/* Move the device into the configured state. */
    213  1.22  drochner 	err = usbd_set_config_no(dev, UDAV_CONFIG_NO, 1); /* idx 0 */
    214   1.1    itojun 	if (err) {
    215  1.39     skrll 		aprint_error_dev(self, "failed to set configuration"
    216  1.39     skrll 		    ", err=%s\n", usbd_errstr(err));
    217   1.1    itojun 		goto bad;
    218   1.1    itojun 	}
    219   1.1    itojun 
    220  1.41  jmcneill 	usb_init_task(&sc->sc_tick_task, udav_tick_task, sc, 0);
    221  1.19        ad 	mutex_init(&sc->sc_mii_lock, MUTEX_DEFAULT, IPL_NONE);
    222  1.48   msaitoh 	usb_init_task(&sc->sc_stop_task, (void (*)(void *))udav_stop_task, sc,
    223  1.48   msaitoh 	    0);
    224   1.1    itojun 
    225   1.1    itojun 	/* get control interface */
    226   1.1    itojun 	err = usbd_device2interface_handle(dev, UDAV_IFACE_INDEX, &iface);
    227   1.1    itojun 	if (err) {
    228  1.24      cube 		aprint_error_dev(self, "failed to get interface, err=%s\n",
    229   1.1    itojun 		       usbd_errstr(err));
    230   1.1    itojun 		goto bad;
    231   1.1    itojun 	}
    232   1.1    itojun 
    233   1.1    itojun 	sc->sc_udev = dev;
    234   1.1    itojun 	sc->sc_ctl_iface = iface;
    235  1.48   msaitoh 	sc->sc_flags = udav_lookup(uaa->uaa_vendor,
    236  1.48   msaitoh 	    uaa->uaa_product)->udav_flags;
    237   1.1    itojun 
    238   1.1    itojun 	/* get interface descriptor */
    239   1.1    itojun 	id = usbd_get_interface_descriptor(sc->sc_ctl_iface);
    240   1.1    itojun 
    241   1.1    itojun 	/* find endpoints */
    242   1.1    itojun 	sc->sc_bulkin_no = sc->sc_bulkout_no = sc->sc_intrin_no = -1;
    243   1.1    itojun 	for (i = 0; i < id->bNumEndpoints; i++) {
    244   1.1    itojun 		ed = usbd_interface2endpoint_descriptor(sc->sc_ctl_iface, i);
    245   1.1    itojun 		if (ed == NULL) {
    246  1.24      cube 			aprint_error_dev(self, "couldn't get endpoint %d\n", i);
    247   1.1    itojun 			goto bad;
    248   1.1    itojun 		}
    249   1.1    itojun 		if ((ed->bmAttributes & UE_XFERTYPE) == UE_BULK &&
    250   1.1    itojun 		    UE_GET_DIR(ed->bEndpointAddress) == UE_DIR_IN)
    251   1.1    itojun 			sc->sc_bulkin_no = ed->bEndpointAddress; /* RX */
    252   1.1    itojun 		else if ((ed->bmAttributes & UE_XFERTYPE) == UE_BULK &&
    253   1.1    itojun 			 UE_GET_DIR(ed->bEndpointAddress) == UE_DIR_OUT)
    254   1.1    itojun 			sc->sc_bulkout_no = ed->bEndpointAddress; /* TX */
    255   1.1    itojun 		else if ((ed->bmAttributes & UE_XFERTYPE) == UE_INTERRUPT &&
    256   1.1    itojun 			 UE_GET_DIR(ed->bEndpointAddress) == UE_DIR_IN)
    257   1.1    itojun 			sc->sc_intrin_no = ed->bEndpointAddress; /* Status */
    258   1.1    itojun 	}
    259   1.1    itojun 
    260   1.1    itojun 	if (sc->sc_bulkin_no == -1 || sc->sc_bulkout_no == -1 ||
    261   1.1    itojun 	    sc->sc_intrin_no == -1) {
    262  1.24      cube 		aprint_error_dev(self, "missing endpoint\n");
    263   1.1    itojun 		goto bad;
    264   1.1    itojun 	}
    265   1.1    itojun 
    266   1.1    itojun 	s = splnet();
    267   1.1    itojun 
    268   1.1    itojun 	/* reset the adapter */
    269   1.1    itojun 	udav_reset(sc);
    270   1.1    itojun 
    271   1.1    itojun 	/* Get Ethernet Address */
    272   1.1    itojun 	err = udav_csr_read(sc, UDAV_PAR, (void *)eaddr, ETHER_ADDR_LEN);
    273   1.1    itojun 	if (err) {
    274  1.24      cube 		aprint_error_dev(self, "read MAC address failed\n");
    275   1.1    itojun 		splx(s);
    276   1.1    itojun 		goto bad;
    277   1.1    itojun 	}
    278   1.1    itojun 
    279   1.1    itojun 	/* Print Ethernet Address */
    280  1.24      cube 	aprint_normal_dev(self, "Ethernet address %s\n", ether_sprintf(eaddr));
    281   1.1    itojun 
    282   1.9       wiz 	/* initialize interface information */
    283   1.1    itojun 	ifp = GET_IFP(sc);
    284   1.1    itojun 	ifp->if_softc = sc;
    285   1.1    itojun 	ifp->if_mtu = ETHERMTU;
    286  1.51      maya 	strlcpy(ifp->if_xname, device_xname(self), IFNAMSIZ);
    287   1.1    itojun 	ifp->if_flags = IFF_BROADCAST | IFF_SIMPLEX | IFF_MULTICAST;
    288   1.1    itojun 	ifp->if_start = udav_start;
    289   1.1    itojun 	ifp->if_ioctl = udav_ioctl;
    290   1.1    itojun 	ifp->if_watchdog = udav_watchdog;
    291   1.1    itojun 	ifp->if_init = udav_init;
    292   1.1    itojun 	ifp->if_stop = udav_stop;
    293   1.1    itojun 
    294   1.1    itojun 	IFQ_SET_READY(&ifp->if_snd);
    295   1.1    itojun 
    296  1.42  jakllsch 	if (ISSET(sc->sc_flags, UDAV_NO_PHY)) {
    297  1.42  jakllsch 		sc->sc_link = 1;
    298  1.42  jakllsch 		goto skipmii;
    299  1.42  jakllsch 	}
    300  1.42  jakllsch 
    301   1.1    itojun 	/*
    302   1.1    itojun 	 * Do ifmedia setup.
    303   1.1    itojun 	 */
    304   1.1    itojun 	mii = &sc->sc_mii;
    305   1.1    itojun 	mii->mii_ifp = ifp;
    306   1.1    itojun 	mii->mii_readreg = udav_miibus_readreg;
    307   1.1    itojun 	mii->mii_writereg = udav_miibus_writereg;
    308   1.1    itojun 	mii->mii_statchg = udav_miibus_statchg;
    309   1.1    itojun 	mii->mii_flags = MIIF_AUTOTSLEEP;
    310  1.21    dyoung 	sc->sc_ec.ec_mii = mii;
    311   1.1    itojun 	ifmedia_init(&mii->mii_media, 0,
    312   1.1    itojun 		     udav_ifmedia_change, udav_ifmedia_status);
    313   1.1    itojun 	mii_attach(self, mii, 0xffffffff, MII_PHY_ANY, MII_OFFSET_ANY, 0);
    314   1.1    itojun 	if (LIST_FIRST(&mii->mii_phys) == NULL) {
    315   1.1    itojun 		ifmedia_add(&mii->mii_media, IFM_ETHER | IFM_NONE, 0, NULL);
    316   1.1    itojun 		ifmedia_set(&mii->mii_media, IFM_ETHER | IFM_NONE);
    317   1.1    itojun 	} else
    318   1.1    itojun 		ifmedia_set(&mii->mii_media, IFM_ETHER | IFM_AUTO);
    319   1.1    itojun 
    320  1.42  jakllsch skipmii:
    321   1.1    itojun 	/* attach the interface */
    322   1.1    itojun 	if_attach(ifp);
    323  1.31    dyoung 	ether_ifattach(ifp, eaddr);
    324   1.1    itojun 
    325  1.24      cube 	rnd_attach_source(&sc->rnd_source, device_xname(self),
    326  1.43       tls 	    RND_TYPE_NET, RND_FLAG_DEFAULT);
    327   1.1    itojun 
    328  1.31    dyoung 	callout_init(&sc->sc_stat_ch, 0);
    329   1.1    itojun 	sc->sc_attached = 1;
    330   1.1    itojun 	splx(s);
    331   1.1    itojun 
    332  1.31    dyoung 	usbd_add_drv_event(USB_EVENT_DRIVER_ATTACH, dev, sc->sc_dev);
    333   1.1    itojun 
    334  1.31    dyoung 	return;
    335   1.1    itojun 
    336   1.1    itojun  bad:
    337   1.1    itojun 	sc->sc_dying = 1;
    338  1.31    dyoung 	return;
    339   1.1    itojun }
    340   1.1    itojun 
    341   1.1    itojun /* detach */
    342  1.40  christos int
    343  1.31    dyoung udav_detach(device_t self, int flags)
    344   1.1    itojun {
    345  1.31    dyoung 	struct udav_softc *sc = device_private(self);
    346   1.1    itojun 	struct ifnet *ifp = GET_IFP(sc);
    347   1.1    itojun 	int s;
    348   1.1    itojun 
    349  1.31    dyoung 	DPRINTF(("%s: %s: enter\n", device_xname(sc->sc_dev), __func__));
    350   1.1    itojun 
    351   1.1    itojun 	/* Detached before attached finished */
    352   1.1    itojun 	if (!sc->sc_attached)
    353  1.46     skrll 		return 0;
    354   1.1    itojun 
    355  1.54  riastrad 	callout_halt(&sc->sc_stat_ch, NULL);
    356   1.1    itojun 
    357   1.1    itojun 	/* Remove any pending tasks */
    358  1.55  riastrad 	usb_rem_task_wait(sc->sc_udev, &sc->sc_tick_task, USB_TASKQ_DRIVER,
    359  1.55  riastrad 	    NULL);
    360  1.55  riastrad 	usb_rem_task_wait(sc->sc_udev, &sc->sc_stop_task, USB_TASKQ_DRIVER,
    361  1.55  riastrad 	    NULL);
    362   1.1    itojun 
    363   1.1    itojun 	s = splusb();
    364   1.1    itojun 
    365   1.1    itojun 	if (--sc->sc_refcnt >= 0) {
    366   1.1    itojun 		/* Wait for processes to go away */
    367  1.36       mrg 		usb_detach_waitold(sc->sc_dev);
    368   1.1    itojun 	}
    369   1.1    itojun 	if (ifp->if_flags & IFF_RUNNING)
    370   1.1    itojun 		udav_stop(GET_IFP(sc), 1);
    371   1.1    itojun 
    372   1.1    itojun 	rnd_detach_source(&sc->rnd_source);
    373   1.1    itojun 	mii_detach(&sc->sc_mii, MII_PHY_ANY, MII_OFFSET_ANY);
    374   1.1    itojun 	ifmedia_delete_instance(&sc->sc_mii.mii_media, IFM_INST_ANY);
    375   1.1    itojun 	ether_ifdetach(ifp);
    376   1.1    itojun 	if_detach(ifp);
    377   1.1    itojun 
    378   1.1    itojun #ifdef DIAGNOSTIC
    379   1.1    itojun 	if (sc->sc_pipe_tx != NULL)
    380  1.24      cube 		aprint_debug_dev(self, "detach has active tx endpoint.\n");
    381   1.1    itojun 	if (sc->sc_pipe_rx != NULL)
    382  1.24      cube 		aprint_debug_dev(self, "detach has active rx endpoint.\n");
    383   1.1    itojun 	if (sc->sc_pipe_intr != NULL)
    384  1.24      cube 		aprint_debug_dev(self, "detach has active intr endpoint.\n");
    385   1.1    itojun #endif
    386   1.1    itojun 	sc->sc_attached = 0;
    387   1.1    itojun 
    388   1.1    itojun 	splx(s);
    389   1.1    itojun 
    390  1.48   msaitoh 	usbd_add_drv_event(USB_EVENT_DRIVER_DETACH, sc->sc_udev, sc->sc_dev);
    391   1.1    itojun 
    392  1.19        ad 	mutex_destroy(&sc->sc_mii_lock);
    393  1.19        ad 
    394  1.46     skrll 	return 0;
    395   1.1    itojun }
    396   1.1    itojun 
    397   1.1    itojun #if 0
    398   1.1    itojun /* read memory */
    399   1.1    itojun Static int
    400   1.1    itojun udav_mem_read(struct udav_softc *sc, int offset, void *buf, int len)
    401   1.1    itojun {
    402   1.1    itojun 	usb_device_request_t req;
    403   1.1    itojun 	usbd_status err;
    404   1.1    itojun 
    405   1.1    itojun 	if (sc == NULL)
    406  1.46     skrll 		return 0;
    407   1.1    itojun 
    408   1.1    itojun 	DPRINTFN(0x200,
    409  1.31    dyoung 		("%s: %s: enter\n", device_xname(sc->sc_dev), __func__));
    410   1.1    itojun 
    411   1.1    itojun 	if (sc->sc_dying)
    412  1.46     skrll 		return 0;
    413   1.1    itojun 
    414   1.1    itojun 	offset &= 0xffff;
    415   1.1    itojun 	len &= 0xff;
    416   1.1    itojun 
    417   1.1    itojun 	req.bmRequestType = UT_READ_VENDOR_DEVICE;
    418   1.1    itojun 	req.bRequest = UDAV_REQ_MEM_READ;
    419   1.1    itojun 	USETW(req.wValue, 0x0000);
    420   1.1    itojun 	USETW(req.wIndex, offset);
    421   1.1    itojun 	USETW(req.wLength, len);
    422   1.1    itojun 
    423   1.1    itojun 	sc->sc_refcnt++;
    424   1.1    itojun 	err = usbd_do_request(sc->sc_udev, &req, buf);
    425   1.1    itojun 	if (--sc->sc_refcnt < 0)
    426  1.36       mrg 		usb_detach_wakeupold(sc->sc_dev);
    427   1.1    itojun 	if (err) {
    428   1.1    itojun 		DPRINTF(("%s: %s: read failed. off=%04x, err=%d\n",
    429  1.31    dyoung 			 device_xname(sc->sc_dev), __func__, offset, err));
    430   1.1    itojun 	}
    431   1.1    itojun 
    432  1.46     skrll 	return err;
    433   1.1    itojun }
    434   1.1    itojun 
    435   1.1    itojun /* write memory */
    436   1.1    itojun Static int
    437   1.1    itojun udav_mem_write(struct udav_softc *sc, int offset, void *buf, int len)
    438   1.1    itojun {
    439   1.1    itojun 	usb_device_request_t req;
    440   1.1    itojun 	usbd_status err;
    441   1.1    itojun 
    442   1.1    itojun 	if (sc == NULL)
    443  1.46     skrll 		return 0;
    444   1.1    itojun 
    445   1.1    itojun 	DPRINTFN(0x200,
    446  1.31    dyoung 		("%s: %s: enter\n", device_xname(sc->sc_dev), __func__));
    447   1.1    itojun 
    448   1.1    itojun 	if (sc->sc_dying)
    449  1.46     skrll 		return 0;
    450   1.1    itojun 
    451   1.1    itojun 	offset &= 0xffff;
    452   1.1    itojun 	len &= 0xff;
    453   1.1    itojun 
    454   1.1    itojun 	req.bmRequestType = UT_WRITE_VENDOR_DEVICE;
    455   1.1    itojun 	req.bRequest = UDAV_REQ_MEM_WRITE;
    456   1.1    itojun 	USETW(req.wValue, 0x0000);
    457   1.1    itojun 	USETW(req.wIndex, offset);
    458   1.1    itojun 	USETW(req.wLength, len);
    459   1.1    itojun 
    460   1.1    itojun 	sc->sc_refcnt++;
    461   1.1    itojun 	err = usbd_do_request(sc->sc_udev, &req, buf);
    462   1.1    itojun 	if (--sc->sc_refcnt < 0)
    463  1.36       mrg 		usb_detach_wakeupold(sc->sc_dev);
    464   1.1    itojun 	if (err) {
    465   1.1    itojun 		DPRINTF(("%s: %s: write failed. off=%04x, err=%d\n",
    466  1.31    dyoung 			 device_xname(sc->sc_dev), __func__, offset, err));
    467   1.1    itojun 	}
    468   1.1    itojun 
    469  1.46     skrll 	return err;
    470   1.1    itojun }
    471   1.1    itojun 
    472   1.1    itojun /* write memory */
    473   1.1    itojun Static int
    474   1.1    itojun udav_mem_write1(struct udav_softc *sc, int offset, unsigned char ch)
    475   1.1    itojun {
    476   1.1    itojun 	usb_device_request_t req;
    477   1.1    itojun 	usbd_status err;
    478   1.1    itojun 
    479   1.1    itojun 	if (sc == NULL)
    480  1.46     skrll 		return 0;
    481   1.1    itojun 
    482   1.1    itojun 	DPRINTFN(0x200,
    483  1.31    dyoung 		("%s: %s: enter\n", device_xname(sc->sc_dev), __func__));
    484   1.1    itojun 
    485   1.1    itojun 	if (sc->sc_dying)
    486  1.46     skrll 		return 0;
    487   1.1    itojun 
    488   1.1    itojun 	offset &= 0xffff;
    489   1.1    itojun 
    490   1.1    itojun 	req.bmRequestType = UT_WRITE_VENDOR_DEVICE;
    491   1.1    itojun 	req.bRequest = UDAV_REQ_MEM_WRITE1;
    492   1.1    itojun 	USETW(req.wValue, ch);
    493   1.1    itojun 	USETW(req.wIndex, offset);
    494   1.1    itojun 	USETW(req.wLength, 0x0000);
    495   1.1    itojun 
    496   1.1    itojun 	sc->sc_refcnt++;
    497   1.1    itojun 	err = usbd_do_request(sc->sc_udev, &req, NULL);
    498   1.1    itojun 	if (--sc->sc_refcnt < 0)
    499  1.36       mrg 		usb_detach_wakeupold(sc->sc_dev);
    500   1.1    itojun 	if (err) {
    501   1.1    itojun 		DPRINTF(("%s: %s: write failed. off=%04x, err=%d\n",
    502  1.31    dyoung 			 device_xname(sc->sc_dev), __func__, offset, err));
    503   1.1    itojun 	}
    504   1.1    itojun 
    505  1.46     skrll 	return err;
    506   1.1    itojun }
    507   1.1    itojun #endif
    508   1.1    itojun 
    509   1.1    itojun /* read register(s) */
    510   1.1    itojun Static int
    511   1.1    itojun udav_csr_read(struct udav_softc *sc, int offset, void *buf, int len)
    512   1.1    itojun {
    513   1.1    itojun 	usb_device_request_t req;
    514   1.1    itojun 	usbd_status err;
    515   1.1    itojun 
    516   1.1    itojun 	if (sc == NULL)
    517  1.46     skrll 		return 0;
    518   1.1    itojun 
    519   1.1    itojun 	DPRINTFN(0x200,
    520  1.31    dyoung 		("%s: %s: enter\n", device_xname(sc->sc_dev), __func__));
    521   1.1    itojun 
    522   1.1    itojun 	if (sc->sc_dying)
    523  1.46     skrll 		return 0;
    524   1.1    itojun 
    525   1.1    itojun 	offset &= 0xff;
    526   1.1    itojun 	len &= 0xff;
    527   1.1    itojun 
    528   1.1    itojun 	req.bmRequestType = UT_READ_VENDOR_DEVICE;
    529   1.1    itojun 	req.bRequest = UDAV_REQ_REG_READ;
    530   1.1    itojun 	USETW(req.wValue, 0x0000);
    531   1.1    itojun 	USETW(req.wIndex, offset);
    532   1.1    itojun 	USETW(req.wLength, len);
    533   1.1    itojun 
    534   1.1    itojun 	sc->sc_refcnt++;
    535   1.1    itojun 	err = usbd_do_request(sc->sc_udev, &req, buf);
    536   1.1    itojun 	if (--sc->sc_refcnt < 0)
    537  1.36       mrg 		usb_detach_wakeupold(sc->sc_dev);
    538   1.1    itojun 	if (err) {
    539   1.1    itojun 		DPRINTF(("%s: %s: read failed. off=%04x, err=%d\n",
    540  1.31    dyoung 			 device_xname(sc->sc_dev), __func__, offset, err));
    541   1.1    itojun 	}
    542   1.1    itojun 
    543  1.46     skrll 	return err;
    544   1.1    itojun }
    545   1.1    itojun 
    546   1.1    itojun /* write register(s) */
    547   1.1    itojun Static int
    548   1.1    itojun udav_csr_write(struct udav_softc *sc, int offset, void *buf, int len)
    549   1.1    itojun {
    550   1.1    itojun 	usb_device_request_t req;
    551   1.1    itojun 	usbd_status err;
    552   1.1    itojun 
    553   1.1    itojun 	if (sc == NULL)
    554  1.46     skrll 		return 0;
    555   1.1    itojun 
    556   1.1    itojun 	DPRINTFN(0x200,
    557  1.31    dyoung 		("%s: %s: enter\n", device_xname(sc->sc_dev), __func__));
    558   1.1    itojun 
    559   1.1    itojun 	if (sc->sc_dying)
    560  1.46     skrll 		return 0;
    561   1.1    itojun 
    562   1.1    itojun 	offset &= 0xff;
    563   1.1    itojun 	len &= 0xff;
    564   1.1    itojun 
    565   1.1    itojun 	req.bmRequestType = UT_WRITE_VENDOR_DEVICE;
    566   1.1    itojun 	req.bRequest = UDAV_REQ_REG_WRITE;
    567   1.1    itojun 	USETW(req.wValue, 0x0000);
    568   1.1    itojun 	USETW(req.wIndex, offset);
    569   1.1    itojun 	USETW(req.wLength, len);
    570   1.1    itojun 
    571   1.1    itojun 	sc->sc_refcnt++;
    572   1.1    itojun 	err = usbd_do_request(sc->sc_udev, &req, buf);
    573   1.1    itojun 	if (--sc->sc_refcnt < 0)
    574  1.36       mrg 		usb_detach_wakeupold(sc->sc_dev);
    575   1.1    itojun 	if (err) {
    576   1.1    itojun 		DPRINTF(("%s: %s: write failed. off=%04x, err=%d\n",
    577  1.31    dyoung 			 device_xname(sc->sc_dev), __func__, offset, err));
    578   1.1    itojun 	}
    579   1.1    itojun 
    580  1.46     skrll 	return err;
    581   1.1    itojun }
    582   1.1    itojun 
    583   1.1    itojun Static int
    584   1.1    itojun udav_csr_read1(struct udav_softc *sc, int offset)
    585   1.1    itojun {
    586  1.46     skrll 	uint8_t val = 0;
    587   1.5     perry 
    588   1.1    itojun 	if (sc == NULL)
    589  1.46     skrll 		return 0;
    590   1.1    itojun 
    591   1.1    itojun 	DPRINTFN(0x200,
    592  1.31    dyoung 		("%s: %s: enter\n", device_xname(sc->sc_dev), __func__));
    593   1.1    itojun 
    594   1.1    itojun 	if (sc->sc_dying)
    595  1.46     skrll 		return 0;
    596   1.1    itojun 
    597  1.46     skrll 	return udav_csr_read(sc, offset, &val, 1) ? 0 : val;
    598   1.1    itojun }
    599   1.1    itojun 
    600   1.1    itojun /* write a register */
    601   1.1    itojun Static int
    602   1.1    itojun udav_csr_write1(struct udav_softc *sc, int offset, unsigned char ch)
    603   1.1    itojun {
    604   1.1    itojun 	usb_device_request_t req;
    605   1.1    itojun 	usbd_status err;
    606   1.1    itojun 
    607   1.1    itojun 	if (sc == NULL)
    608  1.46     skrll 		return 0;
    609   1.1    itojun 
    610   1.1    itojun 	DPRINTFN(0x200,
    611  1.31    dyoung 		("%s: %s: enter\n", device_xname(sc->sc_dev), __func__));
    612   1.1    itojun 
    613   1.1    itojun 	if (sc->sc_dying)
    614  1.46     skrll 		return 0;
    615   1.1    itojun 
    616   1.1    itojun 	offset &= 0xff;
    617   1.1    itojun 
    618   1.1    itojun 	req.bmRequestType = UT_WRITE_VENDOR_DEVICE;
    619   1.1    itojun 	req.bRequest = UDAV_REQ_REG_WRITE1;
    620   1.1    itojun 	USETW(req.wValue, ch);
    621   1.1    itojun 	USETW(req.wIndex, offset);
    622   1.1    itojun 	USETW(req.wLength, 0x0000);
    623   1.1    itojun 
    624   1.1    itojun 	sc->sc_refcnt++;
    625   1.1    itojun 	err = usbd_do_request(sc->sc_udev, &req, NULL);
    626   1.1    itojun 	if (--sc->sc_refcnt < 0)
    627  1.36       mrg 		usb_detach_wakeupold(sc->sc_dev);
    628   1.1    itojun 	if (err) {
    629   1.1    itojun 		DPRINTF(("%s: %s: write failed. off=%04x, err=%d\n",
    630  1.31    dyoung 			 device_xname(sc->sc_dev), __func__, offset, err));
    631   1.1    itojun 	}
    632   1.1    itojun 
    633  1.46     skrll 	return err;
    634   1.1    itojun }
    635   1.1    itojun 
    636   1.1    itojun Static int
    637   1.1    itojun udav_init(struct ifnet *ifp)
    638   1.1    itojun {
    639   1.1    itojun 	struct udav_softc *sc = ifp->if_softc;
    640   1.1    itojun 	struct mii_data *mii = GET_MII(sc);
    641  1.20    dyoung 	uint8_t eaddr[ETHER_ADDR_LEN];
    642  1.21    dyoung 	int rc, s;
    643   1.1    itojun 
    644  1.31    dyoung 	DPRINTF(("%s: %s: enter\n", device_xname(sc->sc_dev), __func__));
    645   1.1    itojun 
    646   1.1    itojun 	if (sc->sc_dying)
    647  1.46     skrll 		return EIO;
    648   1.1    itojun 
    649   1.1    itojun 	s = splnet();
    650   1.1    itojun 
    651   1.1    itojun 	/* Cancel pending I/O and free all TX/RX buffers */
    652   1.1    itojun 	udav_stop(ifp, 1);
    653   1.1    itojun 
    654  1.20    dyoung 	memcpy(eaddr, CLLADDR(ifp->if_sadl), sizeof(eaddr));
    655   1.1    itojun 	udav_csr_write(sc, UDAV_PAR, eaddr, ETHER_ADDR_LEN);
    656   1.1    itojun 
    657   1.1    itojun 	/* Initialize network control register */
    658   1.1    itojun 	/*  Disable loopback  */
    659   1.1    itojun 	UDAV_CLRBIT(sc, UDAV_NCR, UDAV_NCR_LBK0 | UDAV_NCR_LBK1);
    660   1.1    itojun 
    661   1.1    itojun 	/* Initialize RX control register */
    662   1.1    itojun 	UDAV_SETBIT(sc, UDAV_RCR, UDAV_RCR_DIS_LONG | UDAV_RCR_DIS_CRC);
    663   1.1    itojun 
    664   1.1    itojun 	/* If we want promiscuous mode, accept all physical frames. */
    665   1.1    itojun 	if (ifp->if_flags & IFF_PROMISC)
    666  1.58   msaitoh 		UDAV_SETBIT(sc, UDAV_RCR, UDAV_RCR_ALL | UDAV_RCR_PRMSC);
    667   1.1    itojun 	else
    668  1.58   msaitoh 		UDAV_CLRBIT(sc, UDAV_RCR, UDAV_RCR_ALL | UDAV_RCR_PRMSC);
    669   1.1    itojun 
    670   1.1    itojun 	/* Load the multicast filter */
    671   1.1    itojun 	udav_setmulti(sc);
    672   1.1    itojun 
    673   1.1    itojun 	/* Enable RX */
    674   1.1    itojun 	UDAV_SETBIT(sc, UDAV_RCR, UDAV_RCR_RXEN);
    675   1.1    itojun 
    676   1.1    itojun 	/* clear POWER_DOWN state of internal PHY */
    677   1.1    itojun 	UDAV_SETBIT(sc, UDAV_GPCR, UDAV_GPCR_GEP_CNTL0);
    678   1.1    itojun 	UDAV_CLRBIT(sc, UDAV_GPR, UDAV_GPR_GEPIO0);
    679   1.1    itojun 
    680  1.21    dyoung 	if ((rc = mii_mediachg(mii)) == ENXIO)
    681  1.21    dyoung 		rc = 0;
    682  1.21    dyoung 	else if (rc != 0)
    683  1.21    dyoung 		goto out;
    684   1.1    itojun 
    685   1.1    itojun 	if (sc->sc_pipe_tx == NULL || sc->sc_pipe_rx == NULL) {
    686   1.1    itojun 		if (udav_openpipes(sc)) {
    687   1.1    itojun 			splx(s);
    688  1.46     skrll 			return EIO;
    689   1.1    itojun 		}
    690   1.1    itojun 	}
    691   1.1    itojun 
    692  1.46     skrll 	/* Initialize transmit ring */
    693  1.46     skrll 	if (udav_tx_list_init(sc)) {
    694  1.46     skrll 		printf("%s: tx list init failed\n", device_xname(sc->sc_dev));
    695  1.46     skrll 		splx(s);
    696  1.46     skrll 		return EIO;
    697  1.46     skrll 	}
    698  1.46     skrll 
    699  1.46     skrll 	/* Initialize receive ring */
    700  1.46     skrll 	if (udav_rx_list_init(sc)) {
    701  1.46     skrll 		printf("%s: rx list init failed\n", device_xname(sc->sc_dev));
    702  1.46     skrll 		splx(s);
    703  1.46     skrll 		return EIO;
    704  1.46     skrll 	}
    705  1.46     skrll 
    706  1.46     skrll 	/* Start up the receive pipe. */
    707  1.46     skrll 	for (size_t i = 0; i < UDAV_RX_LIST_CNT; i++) {
    708  1.46     skrll 		struct udav_chain *c = &sc->sc_cdata.udav_rx_chain[i];
    709  1.46     skrll 		usbd_setup_xfer(c->udav_xfer, c, c->udav_buf, UDAV_BUFSZ,
    710  1.46     skrll 		    USBD_SHORT_XFER_OK, USBD_NO_TIMEOUT, udav_rxeof);
    711  1.46     skrll 		(void)usbd_transfer(c->udav_xfer);
    712  1.46     skrll 		DPRINTF(("%s: %s: start read\n", device_xname(sc->sc_dev),
    713  1.46     skrll 			 __func__));
    714  1.46     skrll 	}
    715  1.46     skrll 
    716   1.1    itojun 	ifp->if_flags |= IFF_RUNNING;
    717   1.1    itojun 	ifp->if_flags &= ~IFF_OACTIVE;
    718   1.1    itojun 
    719  1.31    dyoung 	callout_reset(&sc->sc_stat_ch, hz, udav_tick, sc);
    720   1.1    itojun 
    721  1.21    dyoung out:
    722  1.21    dyoung 	splx(s);
    723  1.21    dyoung 	return rc;
    724   1.1    itojun }
    725   1.1    itojun 
    726   1.1    itojun Static void
    727   1.1    itojun udav_reset(struct udav_softc *sc)
    728   1.1    itojun {
    729   1.1    itojun 	int i;
    730   1.1    itojun 
    731  1.31    dyoung 	DPRINTF(("%s: %s: enter\n", device_xname(sc->sc_dev), __func__));
    732   1.1    itojun 
    733   1.1    itojun 	if (sc->sc_dying)
    734   1.1    itojun 		return;
    735   1.1    itojun 
    736   1.1    itojun 	/* Select PHY */
    737   1.1    itojun #if 1
    738   1.1    itojun 	/*
    739   1.1    itojun 	 * XXX: force select internal phy.
    740   1.1    itojun 	 *	external phy routines are not tested.
    741   1.1    itojun 	 */
    742   1.1    itojun 	UDAV_CLRBIT(sc, UDAV_NCR, UDAV_NCR_EXT_PHY);
    743   1.1    itojun #else
    744   1.1    itojun 	if (sc->sc_flags & UDAV_EXT_PHY) {
    745   1.1    itojun 		UDAV_SETBIT(sc, UDAV_NCR, UDAV_NCR_EXT_PHY);
    746   1.1    itojun 	} else {
    747   1.1    itojun 		UDAV_CLRBIT(sc, UDAV_NCR, UDAV_NCR_EXT_PHY);
    748   1.1    itojun 	}
    749   1.1    itojun #endif
    750   1.1    itojun 
    751   1.1    itojun 	UDAV_SETBIT(sc, UDAV_NCR, UDAV_NCR_RST);
    752   1.1    itojun 
    753   1.1    itojun 	for (i = 0; i < UDAV_TX_TIMEOUT; i++) {
    754   1.1    itojun 		if (!(udav_csr_read1(sc, UDAV_NCR) & UDAV_NCR_RST))
    755   1.1    itojun 			break;
    756   1.1    itojun 		delay(10);	/* XXX */
    757   1.1    itojun 	}
    758   1.1    itojun 	delay(10000);		/* XXX */
    759   1.1    itojun }
    760   1.1    itojun 
    761   1.1    itojun int
    762  1.31    dyoung udav_activate(device_t self, enum devact act)
    763   1.1    itojun {
    764  1.24      cube 	struct udav_softc *sc = device_private(self);
    765   1.1    itojun 
    766  1.31    dyoung 	DPRINTF(("%s: %s: enter, act=%d\n", device_xname(sc->sc_dev),
    767   1.1    itojun 		 __func__, act));
    768   1.1    itojun 	switch (act) {
    769   1.1    itojun 	case DVACT_DEACTIVATE:
    770   1.1    itojun 		if_deactivate(&sc->sc_ec.ec_if);
    771   1.1    itojun 		sc->sc_dying = 1;
    772  1.27    dyoung 		return 0;
    773  1.27    dyoung 	default:
    774  1.27    dyoung 		return EOPNOTSUPP;
    775   1.1    itojun 	}
    776   1.1    itojun }
    777   1.1    itojun 
    778   1.1    itojun #define UDAV_BITS	6
    779   1.1    itojun 
    780   1.1    itojun #define UDAV_CALCHASH(addr) \
    781   1.1    itojun 	(ether_crc32_le((addr), ETHER_ADDR_LEN) & ((1 << UDAV_BITS) - 1))
    782   1.1    itojun 
    783   1.1    itojun Static void
    784   1.1    itojun udav_setmulti(struct udav_softc *sc)
    785   1.1    itojun {
    786  1.59   msaitoh 	struct ethercom *ec = &sc->sc_ec;
    787   1.1    itojun 	struct ifnet *ifp;
    788   1.1    itojun 	struct ether_multi *enm;
    789   1.1    itojun 	struct ether_multistep step;
    790  1.46     skrll 	uint8_t hashes[8];
    791   1.1    itojun 	int h = 0;
    792   1.1    itojun 
    793  1.31    dyoung 	DPRINTF(("%s: %s: enter\n", device_xname(sc->sc_dev), __func__));
    794   1.1    itojun 
    795   1.1    itojun 	if (sc->sc_dying)
    796   1.1    itojun 		return;
    797   1.1    itojun 
    798   1.1    itojun 	ifp = GET_IFP(sc);
    799   1.1    itojun 
    800  1.42  jakllsch 	if (ISSET(sc->sc_flags, UDAV_NO_PHY)) {
    801  1.42  jakllsch 		UDAV_SETBIT(sc, UDAV_RCR, UDAV_RCR_ALL);
    802  1.42  jakllsch 		UDAV_SETBIT(sc, UDAV_RCR, UDAV_RCR_PRMSC);
    803  1.42  jakllsch 		return;
    804  1.42  jakllsch 	}
    805  1.42  jakllsch 
    806   1.1    itojun 	if (ifp->if_flags & IFF_PROMISC) {
    807  1.58   msaitoh 		UDAV_SETBIT(sc, UDAV_RCR, UDAV_RCR_ALL | UDAV_RCR_PRMSC);
    808   1.1    itojun 		return;
    809   1.1    itojun 	} else if (ifp->if_flags & IFF_ALLMULTI) {
    810  1.59   msaitoh allmulti:
    811   1.1    itojun 		ifp->if_flags |= IFF_ALLMULTI;
    812   1.1    itojun 		UDAV_SETBIT(sc, UDAV_RCR, UDAV_RCR_ALL);
    813   1.1    itojun 		UDAV_CLRBIT(sc, UDAV_RCR, UDAV_RCR_PRMSC);
    814   1.1    itojun 		return;
    815   1.1    itojun 	}
    816   1.1    itojun 
    817   1.1    itojun 	/* first, zot all the existing hash bits */
    818   1.1    itojun 	memset(hashes, 0x00, sizeof(hashes));
    819   1.1    itojun 	hashes[7] |= 0x80;	/* broadcast address */
    820   1.1    itojun 	udav_csr_write(sc, UDAV_MAR, hashes, sizeof(hashes));
    821   1.1    itojun 
    822   1.1    itojun 	/* now program new ones */
    823  1.59   msaitoh 	ETHER_LOCK(ec);
    824  1.59   msaitoh 	ETHER_FIRST_MULTI(step, ec, enm);
    825   1.1    itojun 	while (enm != NULL) {
    826   1.1    itojun 		if (memcmp(enm->enm_addrlo, enm->enm_addrhi,
    827  1.59   msaitoh 		    ETHER_ADDR_LEN) != 0) {
    828  1.59   msaitoh 			ETHER_UNLOCK(ec);
    829   1.1    itojun 			goto allmulti;
    830  1.59   msaitoh 		}
    831   1.1    itojun 
    832   1.1    itojun 		h = UDAV_CALCHASH(enm->enm_addrlo);
    833   1.1    itojun 		hashes[h>>3] |= 1 << (h & 0x7);
    834   1.1    itojun 		ETHER_NEXT_MULTI(step, enm);
    835   1.1    itojun 	}
    836  1.59   msaitoh 	ETHER_UNLOCK(ec);
    837   1.1    itojun 
    838   1.1    itojun 	/* disable all multicast */
    839   1.1    itojun 	ifp->if_flags &= ~IFF_ALLMULTI;
    840   1.1    itojun 	UDAV_CLRBIT(sc, UDAV_RCR, UDAV_RCR_ALL);
    841   1.1    itojun 
    842   1.1    itojun 	/* write hash value to the register */
    843   1.1    itojun 	udav_csr_write(sc, UDAV_MAR, hashes, sizeof(hashes));
    844   1.1    itojun }
    845   1.1    itojun 
    846   1.1    itojun Static int
    847   1.1    itojun udav_openpipes(struct udav_softc *sc)
    848   1.1    itojun {
    849   1.1    itojun 	usbd_status err;
    850   1.1    itojun 	int error = 0;
    851   1.1    itojun 
    852   1.1    itojun 	if (sc->sc_dying)
    853  1.46     skrll 		return EIO;
    854   1.1    itojun 
    855   1.1    itojun 	sc->sc_refcnt++;
    856   1.1    itojun 
    857   1.1    itojun 	/* Open RX pipe */
    858   1.1    itojun 	err = usbd_open_pipe(sc->sc_ctl_iface, sc->sc_bulkin_no,
    859   1.1    itojun 			     USBD_EXCLUSIVE_USE, &sc->sc_pipe_rx);
    860   1.1    itojun 	if (err) {
    861   1.1    itojun 		printf("%s: open rx pipe failed: %s\n",
    862  1.31    dyoung 		       device_xname(sc->sc_dev), usbd_errstr(err));
    863   1.1    itojun 		error = EIO;
    864   1.1    itojun 		goto done;
    865   1.1    itojun 	}
    866   1.1    itojun 
    867   1.1    itojun 	/* Open TX pipe */
    868   1.1    itojun 	err = usbd_open_pipe(sc->sc_ctl_iface, sc->sc_bulkout_no,
    869   1.1    itojun 			     USBD_EXCLUSIVE_USE, &sc->sc_pipe_tx);
    870   1.1    itojun 	if (err) {
    871   1.1    itojun 		printf("%s: open tx pipe failed: %s\n",
    872  1.31    dyoung 		       device_xname(sc->sc_dev), usbd_errstr(err));
    873   1.1    itojun 		error = EIO;
    874   1.1    itojun 		goto done;
    875   1.1    itojun 	}
    876   1.1    itojun 
    877   1.1    itojun #if 0
    878   1.1    itojun 	/* XXX: interrupt endpoint is not yet supported */
    879   1.1    itojun 	/* Open Interrupt pipe */
    880   1.1    itojun 	err = usbd_open_pipe_intr(sc->sc_ctl_iface, sc->sc_intrin_no,
    881   1.1    itojun 				  USBD_EXCLUSIVE_USE, &sc->sc_pipe_intr, sc,
    882   1.1    itojun 				  &sc->sc_cdata.udav_ibuf, UDAV_INTR_PKGLEN,
    883  1.15  drochner 				  udav_intr, USBD_DEFAULT_INTERVAL);
    884   1.1    itojun 	if (err) {
    885   1.1    itojun 		printf("%s: open intr pipe failed: %s\n",
    886  1.31    dyoung 		       device_xname(sc->sc_dev), usbd_errstr(err));
    887   1.1    itojun 		error = EIO;
    888   1.1    itojun 		goto done;
    889   1.1    itojun 	}
    890   1.1    itojun #endif
    891   1.1    itojun  done:
    892   1.1    itojun 	if (--sc->sc_refcnt < 0)
    893  1.36       mrg 		usb_detach_wakeupold(sc->sc_dev);
    894   1.1    itojun 
    895  1.46     skrll 	return error;
    896   1.1    itojun }
    897   1.1    itojun 
    898   1.1    itojun Static int
    899   1.1    itojun udav_newbuf(struct udav_softc *sc, struct udav_chain *c, struct mbuf *m)
    900   1.1    itojun {
    901   1.1    itojun 	struct mbuf *m_new = NULL;
    902   1.1    itojun 
    903  1.31    dyoung 	DPRINTF(("%s: %s: enter\n", device_xname(sc->sc_dev), __func__));
    904   1.1    itojun 
    905   1.1    itojun 	if (m == NULL) {
    906   1.1    itojun 		MGETHDR(m_new, M_DONTWAIT, MT_DATA);
    907   1.1    itojun 		if (m_new == NULL) {
    908   1.1    itojun 			printf("%s: no memory for rx list "
    909  1.31    dyoung 			       "-- packet dropped!\n", device_xname(sc->sc_dev));
    910  1.46     skrll 			return ENOBUFS;
    911   1.1    itojun 		}
    912   1.1    itojun 		MCLGET(m_new, M_DONTWAIT);
    913   1.1    itojun 		if (!(m_new->m_flags & M_EXT)) {
    914   1.1    itojun 			printf("%s: no memory for rx list "
    915  1.31    dyoung 			       "-- packet dropped!\n", device_xname(sc->sc_dev));
    916   1.1    itojun 			m_freem(m_new);
    917  1.46     skrll 			return ENOBUFS;
    918   1.1    itojun 		}
    919   1.1    itojun 		m_new->m_len = m_new->m_pkthdr.len = MCLBYTES;
    920   1.1    itojun 	} else {
    921   1.1    itojun 		m_new = m;
    922   1.1    itojun 		m_new->m_len = m_new->m_pkthdr.len = MCLBYTES;
    923   1.1    itojun 		m_new->m_data = m_new->m_ext.ext_buf;
    924   1.1    itojun 	}
    925   1.1    itojun 
    926   1.1    itojun 	m_adj(m_new, ETHER_ALIGN);
    927   1.1    itojun 	c->udav_mbuf = m_new;
    928   1.1    itojun 
    929  1.46     skrll 	return 0;
    930   1.1    itojun }
    931   1.1    itojun 
    932   1.1    itojun 
    933   1.1    itojun Static int
    934   1.1    itojun udav_rx_list_init(struct udav_softc *sc)
    935   1.1    itojun {
    936   1.1    itojun 	struct udav_cdata *cd;
    937   1.1    itojun 	struct udav_chain *c;
    938   1.1    itojun 	int i;
    939   1.1    itojun 
    940  1.31    dyoung 	DPRINTF(("%s: %s: enter\n", device_xname(sc->sc_dev), __func__));
    941   1.1    itojun 
    942   1.1    itojun 	cd = &sc->sc_cdata;
    943   1.1    itojun 	for (i = 0; i < UDAV_RX_LIST_CNT; i++) {
    944   1.1    itojun 		c = &cd->udav_rx_chain[i];
    945   1.1    itojun 		c->udav_sc = sc;
    946   1.1    itojun 		c->udav_idx = i;
    947   1.1    itojun 		if (udav_newbuf(sc, c, NULL) == ENOBUFS)
    948  1.46     skrll 			return ENOBUFS;
    949   1.1    itojun 		if (c->udav_xfer == NULL) {
    950  1.48   msaitoh 			int error = usbd_create_xfer(sc->sc_pipe_rx,
    951  1.52     skrll 			    UDAV_BUFSZ, 0, 0, &c->udav_xfer);
    952  1.46     skrll 			if (error)
    953  1.46     skrll 				return error;
    954  1.46     skrll 			c->udav_buf = usbd_get_buffer(c->udav_xfer);
    955   1.1    itojun 		}
    956   1.1    itojun 	}
    957   1.1    itojun 
    958  1.46     skrll 	return 0;
    959   1.1    itojun }
    960   1.1    itojun 
    961   1.1    itojun Static int
    962   1.1    itojun udav_tx_list_init(struct udav_softc *sc)
    963   1.1    itojun {
    964   1.1    itojun 	struct udav_cdata *cd;
    965   1.1    itojun 	struct udav_chain *c;
    966   1.1    itojun 	int i;
    967   1.1    itojun 
    968  1.31    dyoung 	DPRINTF(("%s: %s: enter\n", device_xname(sc->sc_dev), __func__));
    969   1.1    itojun 
    970   1.1    itojun 	cd = &sc->sc_cdata;
    971   1.1    itojun 	for (i = 0; i < UDAV_TX_LIST_CNT; i++) {
    972   1.1    itojun 		c = &cd->udav_tx_chain[i];
    973   1.1    itojun 		c->udav_sc = sc;
    974   1.1    itojun 		c->udav_idx = i;
    975   1.1    itojun 		c->udav_mbuf = NULL;
    976   1.1    itojun 		if (c->udav_xfer == NULL) {
    977  1.46     skrll 			int error = usbd_create_xfer(sc->sc_pipe_tx, UDAV_BUFSZ,
    978  1.46     skrll 			    USBD_FORCE_SHORT_XFER, 0, &c->udav_xfer);
    979  1.46     skrll 			if (error)
    980  1.46     skrll 				return error;
    981  1.46     skrll 			c->udav_buf = usbd_get_buffer(c->udav_xfer);
    982   1.1    itojun 		}
    983   1.1    itojun 	}
    984   1.1    itojun 
    985  1.46     skrll 	return 0;
    986   1.1    itojun }
    987   1.1    itojun 
    988   1.1    itojun Static void
    989   1.1    itojun udav_start(struct ifnet *ifp)
    990   1.1    itojun {
    991   1.1    itojun 	struct udav_softc *sc = ifp->if_softc;
    992   1.1    itojun 	struct mbuf *m_head = NULL;
    993   1.1    itojun 
    994  1.31    dyoung 	DPRINTF(("%s: %s: enter, link=%d\n", device_xname(sc->sc_dev),
    995   1.1    itojun 		 __func__, sc->sc_link));
    996   1.1    itojun 
    997   1.1    itojun 	if (sc->sc_dying)
    998   1.1    itojun 		return;
    999   1.1    itojun 
   1000   1.1    itojun 	if (!sc->sc_link)
   1001   1.1    itojun 		return;
   1002   1.1    itojun 
   1003   1.1    itojun 	if (ifp->if_flags & IFF_OACTIVE)
   1004   1.1    itojun 		return;
   1005   1.1    itojun 
   1006   1.1    itojun 	IFQ_POLL(&ifp->if_snd, m_head);
   1007   1.1    itojun 	if (m_head == NULL)
   1008   1.1    itojun 		return;
   1009   1.1    itojun 
   1010   1.1    itojun 	if (udav_send(sc, m_head, 0)) {
   1011   1.1    itojun 		ifp->if_flags |= IFF_OACTIVE;
   1012   1.1    itojun 		return;
   1013   1.1    itojun 	}
   1014   1.1    itojun 
   1015   1.1    itojun 	IFQ_DEQUEUE(&ifp->if_snd, m_head);
   1016   1.1    itojun 
   1017  1.53   msaitoh 	bpf_mtap(ifp, m_head, BPF_D_OUT);
   1018   1.1    itojun 
   1019   1.1    itojun 	ifp->if_flags |= IFF_OACTIVE;
   1020   1.1    itojun 
   1021   1.1    itojun 	/* Set a timeout in case the chip goes out to lunch. */
   1022   1.1    itojun 	ifp->if_timer = 5;
   1023   1.1    itojun }
   1024   1.1    itojun 
   1025   1.1    itojun Static int
   1026   1.1    itojun udav_send(struct udav_softc *sc, struct mbuf *m, int idx)
   1027   1.1    itojun {
   1028   1.1    itojun 	int total_len;
   1029   1.1    itojun 	struct udav_chain *c;
   1030   1.1    itojun 	usbd_status err;
   1031   1.1    itojun 
   1032  1.31    dyoung 	DPRINTF(("%s: %s: enter\n", device_xname(sc->sc_dev),__func__));
   1033   1.1    itojun 
   1034   1.1    itojun 	c = &sc->sc_cdata.udav_tx_chain[idx];
   1035   1.1    itojun 
   1036   1.1    itojun 	/* Copy the mbuf data into a contiguous buffer */
   1037   1.1    itojun 	/*  first 2 bytes are packet length */
   1038   1.1    itojun 	m_copydata(m, 0, m->m_pkthdr.len, c->udav_buf + 2);
   1039   1.1    itojun 	c->udav_mbuf = m;
   1040   1.1    itojun 	total_len = m->m_pkthdr.len;
   1041   1.1    itojun 	if (total_len < UDAV_MIN_FRAME_LEN) {
   1042   1.1    itojun 		memset(c->udav_buf + 2 + total_len, 0,
   1043   1.1    itojun 		    UDAV_MIN_FRAME_LEN - total_len);
   1044   1.1    itojun 		total_len = UDAV_MIN_FRAME_LEN;
   1045   1.1    itojun 	}
   1046   1.1    itojun 
   1047   1.1    itojun 	/* Frame length is specified in the first 2bytes of the buffer */
   1048  1.46     skrll 	c->udav_buf[0] = (uint8_t)total_len;
   1049  1.46     skrll 	c->udav_buf[1] = (uint8_t)(total_len >> 8);
   1050   1.1    itojun 	total_len += 2;
   1051   1.1    itojun 
   1052  1.46     skrll 	usbd_setup_xfer(c->udav_xfer, c, c->udav_buf, total_len,
   1053  1.46     skrll 	    USBD_FORCE_SHORT_XFER, UDAV_TX_TIMEOUT, udav_txeof);
   1054   1.1    itojun 
   1055   1.1    itojun 	/* Transmit */
   1056   1.1    itojun 	sc->sc_refcnt++;
   1057   1.1    itojun 	err = usbd_transfer(c->udav_xfer);
   1058   1.1    itojun 	if (--sc->sc_refcnt < 0)
   1059  1.36       mrg 		usb_detach_wakeupold(sc->sc_dev);
   1060   1.1    itojun 	if (err != USBD_IN_PROGRESS) {
   1061  1.31    dyoung 		printf("%s: udav_send error=%s\n", device_xname(sc->sc_dev),
   1062   1.1    itojun 		       usbd_errstr(err));
   1063   1.1    itojun 		/* Stop the interface */
   1064  1.13     joerg 		usb_add_task(sc->sc_udev, &sc->sc_stop_task,
   1065  1.13     joerg 		    USB_TASKQ_DRIVER);
   1066  1.46     skrll 		return EIO;
   1067   1.1    itojun 	}
   1068   1.1    itojun 
   1069  1.31    dyoung 	DPRINTF(("%s: %s: send %d bytes\n", device_xname(sc->sc_dev),
   1070   1.1    itojun 		 __func__, total_len));
   1071   1.1    itojun 
   1072   1.1    itojun 	sc->sc_cdata.udav_tx_cnt++;
   1073   1.1    itojun 
   1074  1.46     skrll 	return 0;
   1075   1.1    itojun }
   1076   1.1    itojun 
   1077   1.1    itojun Static void
   1078  1.46     skrll udav_txeof(struct usbd_xfer *xfer, void *priv,
   1079  1.12  christos     usbd_status status)
   1080   1.1    itojun {
   1081   1.1    itojun 	struct udav_chain *c = priv;
   1082   1.1    itojun 	struct udav_softc *sc = c->udav_sc;
   1083   1.1    itojun 	struct ifnet *ifp = GET_IFP(sc);
   1084   1.1    itojun 	int s;
   1085   1.1    itojun 
   1086   1.1    itojun 	if (sc->sc_dying)
   1087   1.1    itojun 		return;
   1088   1.1    itojun 
   1089   1.1    itojun 	s = splnet();
   1090   1.1    itojun 
   1091  1.31    dyoung 	DPRINTF(("%s: %s: enter\n", device_xname(sc->sc_dev), __func__));
   1092   1.1    itojun 
   1093   1.1    itojun 	ifp->if_timer = 0;
   1094   1.1    itojun 	ifp->if_flags &= ~IFF_OACTIVE;
   1095   1.1    itojun 
   1096   1.1    itojun 	if (status != USBD_NORMAL_COMPLETION) {
   1097   1.1    itojun 		if (status == USBD_NOT_STARTED || status == USBD_CANCELLED) {
   1098   1.1    itojun 			splx(s);
   1099   1.1    itojun 			return;
   1100   1.1    itojun 		}
   1101   1.1    itojun 		ifp->if_oerrors++;
   1102  1.31    dyoung 		printf("%s: usb error on tx: %s\n", device_xname(sc->sc_dev),
   1103   1.1    itojun 		       usbd_errstr(status));
   1104   1.1    itojun 		if (status == USBD_STALLED) {
   1105   1.1    itojun 			sc->sc_refcnt++;
   1106   1.8  augustss 			usbd_clear_endpoint_stall_async(sc->sc_pipe_tx);
   1107   1.1    itojun 			if (--sc->sc_refcnt < 0)
   1108  1.36       mrg 				usb_detach_wakeupold(sc->sc_dev);
   1109   1.1    itojun 		}
   1110   1.1    itojun 		splx(s);
   1111   1.1    itojun 		return;
   1112   1.1    itojun 	}
   1113   1.1    itojun 
   1114   1.1    itojun 	ifp->if_opackets++;
   1115   1.1    itojun 
   1116   1.1    itojun 	m_freem(c->udav_mbuf);
   1117   1.1    itojun 	c->udav_mbuf = NULL;
   1118   1.1    itojun 
   1119   1.1    itojun 	if (IFQ_IS_EMPTY(&ifp->if_snd) == 0)
   1120   1.1    itojun 		udav_start(ifp);
   1121   1.1    itojun 
   1122   1.1    itojun 	splx(s);
   1123   1.1    itojun }
   1124   1.1    itojun 
   1125   1.1    itojun Static void
   1126  1.46     skrll udav_rxeof(struct usbd_xfer *xfer, void *priv, usbd_status status)
   1127   1.1    itojun {
   1128   1.1    itojun 	struct udav_chain *c = priv;
   1129   1.1    itojun 	struct udav_softc *sc = c->udav_sc;
   1130   1.1    itojun 	struct ifnet *ifp = GET_IFP(sc);
   1131   1.1    itojun 	struct mbuf *m;
   1132  1.46     skrll 	uint32_t total_len;
   1133  1.46     skrll 	uint8_t *pktstat;
   1134   1.1    itojun 	int s;
   1135   1.1    itojun 
   1136  1.31    dyoung 	DPRINTF(("%s: %s: enter\n", device_xname(sc->sc_dev),__func__));
   1137   1.1    itojun 
   1138   1.1    itojun 	if (sc->sc_dying)
   1139   1.1    itojun 		return;
   1140   1.1    itojun 
   1141   1.1    itojun 	if (status != USBD_NORMAL_COMPLETION) {
   1142   1.1    itojun 		if (status == USBD_NOT_STARTED || status == USBD_CANCELLED)
   1143   1.1    itojun 			return;
   1144   1.1    itojun 		sc->sc_rx_errs++;
   1145   1.1    itojun 		if (usbd_ratecheck(&sc->sc_rx_notice)) {
   1146   1.1    itojun 			printf("%s: %u usb errors on rx: %s\n",
   1147  1.31    dyoung 			       device_xname(sc->sc_dev), sc->sc_rx_errs,
   1148   1.1    itojun 			       usbd_errstr(status));
   1149   1.1    itojun 			sc->sc_rx_errs = 0;
   1150   1.1    itojun 		}
   1151   1.1    itojun 		if (status == USBD_STALLED) {
   1152   1.1    itojun 			sc->sc_refcnt++;
   1153   1.8  augustss 			usbd_clear_endpoint_stall_async(sc->sc_pipe_rx);
   1154   1.1    itojun 			if (--sc->sc_refcnt < 0)
   1155  1.36       mrg 				usb_detach_wakeupold(sc->sc_dev);
   1156   1.1    itojun 		}
   1157   1.1    itojun 		goto done;
   1158   1.1    itojun 	}
   1159   1.1    itojun 
   1160   1.1    itojun 	usbd_get_xfer_status(xfer, NULL, NULL, &total_len, NULL);
   1161   1.1    itojun 
   1162   1.1    itojun 	/* copy data to mbuf */
   1163   1.1    itojun 	m = c->udav_mbuf;
   1164   1.1    itojun 	memcpy(mtod(m, char *), c->udav_buf, total_len);
   1165   1.1    itojun 
   1166   1.1    itojun 	/* first byte in received data */
   1167  1.46     skrll 	pktstat = mtod(m, uint8_t *);
   1168  1.46     skrll 	m_adj(m, sizeof(uint8_t));
   1169  1.31    dyoung 	DPRINTF(("%s: RX Status: 0x%02x\n", device_xname(sc->sc_dev),
   1170  1.10  christos 				*pktstat));
   1171   1.1    itojun 
   1172  1.46     skrll 	total_len = UGETW(mtod(m, uint8_t *));
   1173  1.46     skrll 	m_adj(m, sizeof(uint16_t));
   1174   1.1    itojun 
   1175   1.1    itojun 	if (*pktstat & UDAV_RSR_LCS) {
   1176   1.1    itojun 		ifp->if_collisions++;
   1177   1.1    itojun 		goto done;
   1178   1.1    itojun 	}
   1179   1.1    itojun 
   1180   1.1    itojun 	if (total_len < sizeof(struct ether_header) ||
   1181   1.1    itojun 	    *pktstat & UDAV_RSR_ERR) {
   1182   1.1    itojun 		ifp->if_ierrors++;
   1183   1.1    itojun 		goto done;
   1184   1.1    itojun 	}
   1185   1.1    itojun 
   1186   1.1    itojun 	total_len -= ETHER_CRC_LEN;
   1187   1.1    itojun 
   1188   1.1    itojun 	m->m_pkthdr.len = m->m_len = total_len;
   1189  1.47     ozaki 	m_set_rcvif(m, ifp);
   1190   1.1    itojun 
   1191   1.1    itojun 	s = splnet();
   1192   1.1    itojun 
   1193   1.1    itojun 	if (udav_newbuf(sc, c, NULL) == ENOBUFS) {
   1194   1.1    itojun 		ifp->if_ierrors++;
   1195   1.1    itojun 		goto done1;
   1196   1.1    itojun 	}
   1197   1.1    itojun 
   1198  1.31    dyoung 	DPRINTF(("%s: %s: deliver %d\n", device_xname(sc->sc_dev),
   1199   1.1    itojun 		 __func__, m->m_len));
   1200  1.45     ozaki 	if_percpuq_enqueue((ifp)->if_percpuq, (m));
   1201   1.1    itojun 
   1202   1.1    itojun  done1:
   1203   1.1    itojun 	splx(s);
   1204   1.1    itojun 
   1205   1.1    itojun  done:
   1206   1.1    itojun 	/* Setup new transfer */
   1207  1.46     skrll 	usbd_setup_xfer(xfer, c, c->udav_buf, UDAV_BUFSZ, USBD_SHORT_XFER_OK,
   1208  1.46     skrll 	    USBD_NO_TIMEOUT, udav_rxeof);
   1209   1.1    itojun 	sc->sc_refcnt++;
   1210   1.1    itojun 	usbd_transfer(xfer);
   1211   1.1    itojun 	if (--sc->sc_refcnt < 0)
   1212  1.36       mrg 		usb_detach_wakeupold(sc->sc_dev);
   1213   1.1    itojun 
   1214  1.31    dyoung 	DPRINTF(("%s: %s: start rx\n", device_xname(sc->sc_dev), __func__));
   1215   1.1    itojun }
   1216   1.1    itojun 
   1217   1.1    itojun #if 0
   1218  1.25    cegger Static void udav_intr(void)
   1219   1.1    itojun {
   1220   1.1    itojun }
   1221   1.1    itojun #endif
   1222   1.1    itojun 
   1223   1.1    itojun Static int
   1224  1.16  christos udav_ioctl(struct ifnet *ifp, u_long cmd, void *data)
   1225   1.1    itojun {
   1226   1.1    itojun 	struct udav_softc *sc = ifp->if_softc;
   1227   1.1    itojun 	int s, error = 0;
   1228   1.1    itojun 
   1229  1.31    dyoung 	DPRINTF(("%s: %s: enter\n", device_xname(sc->sc_dev), __func__));
   1230   1.1    itojun 
   1231   1.1    itojun 	if (sc->sc_dying)
   1232  1.46     skrll 		return EIO;
   1233   1.1    itojun 
   1234   1.1    itojun 	s = splnet();
   1235   1.1    itojun 
   1236  1.21    dyoung 	error = ether_ioctl(ifp, cmd, data);
   1237  1.21    dyoung 	if (error == ENETRESET) {
   1238  1.21    dyoung 		if (ifp->if_flags & IFF_RUNNING)
   1239  1.21    dyoung 			udav_setmulti(sc);
   1240  1.21    dyoung 		error = 0;
   1241   1.1    itojun 	}
   1242   1.1    itojun 
   1243   1.1    itojun 	splx(s);
   1244   1.1    itojun 
   1245  1.46     skrll 	return error;
   1246   1.1    itojun }
   1247   1.1    itojun 
   1248   1.1    itojun Static void
   1249   1.1    itojun udav_watchdog(struct ifnet *ifp)
   1250   1.1    itojun {
   1251   1.1    itojun 	struct udav_softc *sc = ifp->if_softc;
   1252   1.1    itojun 	struct udav_chain *c;
   1253   1.1    itojun 	usbd_status stat;
   1254   1.1    itojun 	int s;
   1255   1.1    itojun 
   1256  1.31    dyoung 	DPRINTF(("%s: %s: enter\n", device_xname(sc->sc_dev), __func__));
   1257   1.1    itojun 
   1258   1.1    itojun 	ifp->if_oerrors++;
   1259  1.31    dyoung 	printf("%s: watchdog timeout\n", device_xname(sc->sc_dev));
   1260   1.1    itojun 
   1261   1.1    itojun 	s = splusb();
   1262   1.1    itojun 	c = &sc->sc_cdata.udav_tx_chain[0];
   1263   1.1    itojun 	usbd_get_xfer_status(c->udav_xfer, NULL, NULL, NULL, &stat);
   1264   1.1    itojun 	udav_txeof(c->udav_xfer, c, stat);
   1265   1.1    itojun 
   1266   1.1    itojun 	if (IFQ_IS_EMPTY(&ifp->if_snd) == 0)
   1267   1.1    itojun 		udav_start(ifp);
   1268   1.1    itojun 	splx(s);
   1269   1.1    itojun }
   1270   1.1    itojun 
   1271   1.1    itojun Static void
   1272   1.1    itojun udav_stop_task(struct udav_softc *sc)
   1273   1.1    itojun {
   1274   1.1    itojun 	udav_stop(GET_IFP(sc), 1);
   1275   1.1    itojun }
   1276   1.1    itojun 
   1277   1.1    itojun /* Stop the adapter and free any mbufs allocated to the RX and TX lists. */
   1278   1.1    itojun Static void
   1279  1.14  christos udav_stop(struct ifnet *ifp, int disable)
   1280   1.1    itojun {
   1281   1.1    itojun 	struct udav_softc *sc = ifp->if_softc;
   1282   1.1    itojun 	usbd_status err;
   1283   1.1    itojun 	int i;
   1284   1.1    itojun 
   1285  1.31    dyoung 	DPRINTF(("%s: %s: enter\n", device_xname(sc->sc_dev), __func__));
   1286   1.1    itojun 
   1287   1.1    itojun 	ifp->if_timer = 0;
   1288   1.1    itojun 
   1289   1.1    itojun 	udav_reset(sc);
   1290   1.1    itojun 
   1291  1.31    dyoung 	callout_stop(&sc->sc_stat_ch);
   1292   1.1    itojun 
   1293   1.1    itojun 	/* Stop transfers */
   1294   1.1    itojun 	/* RX endpoint */
   1295   1.1    itojun 	if (sc->sc_pipe_rx != NULL) {
   1296   1.1    itojun 		err = usbd_abort_pipe(sc->sc_pipe_rx);
   1297   1.1    itojun 		if (err)
   1298   1.1    itojun 			printf("%s: abort rx pipe failed: %s\n",
   1299  1.31    dyoung 			       device_xname(sc->sc_dev), usbd_errstr(err));
   1300   1.1    itojun 	}
   1301   1.1    itojun 
   1302   1.1    itojun 	/* TX endpoint */
   1303   1.1    itojun 	if (sc->sc_pipe_tx != NULL) {
   1304   1.1    itojun 		err = usbd_abort_pipe(sc->sc_pipe_tx);
   1305   1.1    itojun 		if (err)
   1306   1.1    itojun 			printf("%s: abort tx pipe failed: %s\n",
   1307  1.31    dyoung 			       device_xname(sc->sc_dev), usbd_errstr(err));
   1308   1.1    itojun 	}
   1309   1.1    itojun 
   1310   1.1    itojun #if 0
   1311   1.1    itojun 	/* XXX: Interrupt endpoint is not yet supported!! */
   1312   1.1    itojun 	/* Interrupt endpoint */
   1313   1.1    itojun 	if (sc->sc_pipe_intr != NULL) {
   1314   1.1    itojun 		err = usbd_abort_pipe(sc->sc_pipe_intr);
   1315   1.1    itojun 		if (err)
   1316   1.1    itojun 			printf("%s: abort intr pipe failed: %s\n",
   1317  1.31    dyoung 			       device_xname(sc->sc_dev), usbd_errstr(err));
   1318   1.1    itojun 		err = usbd_close_pipe(sc->sc_pipe_intr);
   1319   1.1    itojun 		if (err)
   1320   1.1    itojun 			printf("%s: close intr pipe failed: %s\n",
   1321  1.31    dyoung 			       device_xname(sc->sc_dev), usbd_errstr(err));
   1322   1.1    itojun 		sc->sc_pipe_intr = NULL;
   1323   1.1    itojun 	}
   1324   1.1    itojun #endif
   1325   1.1    itojun 
   1326   1.1    itojun 	/* Free RX resources. */
   1327   1.1    itojun 	for (i = 0; i < UDAV_RX_LIST_CNT; i++) {
   1328   1.1    itojun 		if (sc->sc_cdata.udav_rx_chain[i].udav_mbuf != NULL) {
   1329   1.1    itojun 			m_freem(sc->sc_cdata.udav_rx_chain[i].udav_mbuf);
   1330   1.1    itojun 			sc->sc_cdata.udav_rx_chain[i].udav_mbuf = NULL;
   1331   1.1    itojun 		}
   1332   1.1    itojun 		if (sc->sc_cdata.udav_rx_chain[i].udav_xfer != NULL) {
   1333  1.46     skrll 			usbd_destroy_xfer(sc->sc_cdata.udav_rx_chain[i].udav_xfer);
   1334   1.1    itojun 			sc->sc_cdata.udav_rx_chain[i].udav_xfer = NULL;
   1335   1.1    itojun 		}
   1336   1.1    itojun 	}
   1337   1.1    itojun 
   1338   1.1    itojun 	/* Free TX resources. */
   1339   1.1    itojun 	for (i = 0; i < UDAV_TX_LIST_CNT; i++) {
   1340   1.1    itojun 		if (sc->sc_cdata.udav_tx_chain[i].udav_mbuf != NULL) {
   1341   1.1    itojun 			m_freem(sc->sc_cdata.udav_tx_chain[i].udav_mbuf);
   1342   1.1    itojun 			sc->sc_cdata.udav_tx_chain[i].udav_mbuf = NULL;
   1343   1.1    itojun 		}
   1344   1.1    itojun 		if (sc->sc_cdata.udav_tx_chain[i].udav_xfer != NULL) {
   1345  1.46     skrll 			usbd_destroy_xfer(sc->sc_cdata.udav_tx_chain[i].udav_xfer);
   1346   1.1    itojun 			sc->sc_cdata.udav_tx_chain[i].udav_xfer = NULL;
   1347   1.1    itojun 		}
   1348   1.1    itojun 	}
   1349   1.1    itojun 
   1350  1.46     skrll 	/* Close pipes */
   1351  1.46     skrll 	/* RX endpoint */
   1352  1.46     skrll 	if (sc->sc_pipe_rx != NULL) {
   1353  1.46     skrll 		err = usbd_close_pipe(sc->sc_pipe_rx);
   1354  1.46     skrll 		if (err)
   1355  1.46     skrll 			printf("%s: close rx pipe failed: %s\n",
   1356  1.46     skrll 			       device_xname(sc->sc_dev), usbd_errstr(err));
   1357  1.46     skrll 		sc->sc_pipe_rx = NULL;
   1358  1.46     skrll 	}
   1359  1.46     skrll 
   1360  1.46     skrll 	/* TX endpoint */
   1361  1.46     skrll 	if (sc->sc_pipe_tx != NULL) {
   1362  1.46     skrll 		err = usbd_close_pipe(sc->sc_pipe_tx);
   1363  1.46     skrll 		if (err)
   1364  1.46     skrll 			printf("%s: close tx pipe failed: %s\n",
   1365  1.46     skrll 			       device_xname(sc->sc_dev), usbd_errstr(err));
   1366  1.46     skrll 		sc->sc_pipe_tx = NULL;
   1367  1.46     skrll 	}
   1368  1.46     skrll 
   1369  1.42  jakllsch 	if (!ISSET(sc->sc_flags, UDAV_NO_PHY))
   1370  1.42  jakllsch 		sc->sc_link = 0;
   1371   1.1    itojun 	ifp->if_flags &= ~(IFF_RUNNING | IFF_OACTIVE);
   1372   1.1    itojun }
   1373   1.1    itojun 
   1374   1.1    itojun /* Set media options */
   1375   1.1    itojun Static int
   1376   1.1    itojun udav_ifmedia_change(struct ifnet *ifp)
   1377   1.1    itojun {
   1378   1.1    itojun 	struct udav_softc *sc = ifp->if_softc;
   1379   1.1    itojun 	struct mii_data *mii = GET_MII(sc);
   1380  1.21    dyoung 	int rc;
   1381   1.1    itojun 
   1382  1.31    dyoung 	DPRINTF(("%s: %s: enter\n", device_xname(sc->sc_dev), __func__));
   1383   1.1    itojun 
   1384   1.1    itojun 	if (sc->sc_dying)
   1385  1.46     skrll 		return 0;
   1386   1.1    itojun 
   1387   1.1    itojun 	sc->sc_link = 0;
   1388  1.21    dyoung 	if ((rc = mii_mediachg(mii)) == ENXIO)
   1389  1.21    dyoung 		return 0;
   1390  1.21    dyoung 	return rc;
   1391   1.1    itojun }
   1392   1.1    itojun 
   1393   1.1    itojun /* Report current media status. */
   1394   1.1    itojun Static void
   1395   1.1    itojun udav_ifmedia_status(struct ifnet *ifp, struct ifmediareq *ifmr)
   1396   1.1    itojun {
   1397   1.1    itojun 	struct udav_softc *sc = ifp->if_softc;
   1398   1.1    itojun 
   1399  1.31    dyoung 	DPRINTF(("%s: %s: enter\n", device_xname(sc->sc_dev), __func__));
   1400   1.1    itojun 
   1401   1.1    itojun 	if (sc->sc_dying)
   1402   1.1    itojun 		return;
   1403   1.1    itojun 
   1404  1.21    dyoung 	ether_mediastatus(ifp, ifmr);
   1405   1.1    itojun }
   1406   1.1    itojun 
   1407   1.1    itojun Static void
   1408   1.1    itojun udav_tick(void *xsc)
   1409   1.1    itojun {
   1410   1.1    itojun 	struct udav_softc *sc = xsc;
   1411   1.1    itojun 
   1412   1.1    itojun 	if (sc == NULL)
   1413   1.1    itojun 		return;
   1414   1.1    itojun 
   1415  1.31    dyoung 	DPRINTFN(0xff, ("%s: %s: enter\n", device_xname(sc->sc_dev),
   1416   1.1    itojun 			__func__));
   1417   1.1    itojun 
   1418   1.1    itojun 	if (sc->sc_dying)
   1419   1.1    itojun 		return;
   1420   1.1    itojun 
   1421   1.1    itojun 	/* Perform periodic stuff in process context */
   1422  1.13     joerg 	usb_add_task(sc->sc_udev, &sc->sc_tick_task,
   1423  1.13     joerg 	    USB_TASKQ_DRIVER);
   1424   1.1    itojun }
   1425   1.1    itojun 
   1426   1.1    itojun Static void
   1427   1.1    itojun udav_tick_task(void *xsc)
   1428   1.1    itojun {
   1429   1.1    itojun 	struct udav_softc *sc = xsc;
   1430   1.1    itojun 	struct ifnet *ifp;
   1431   1.1    itojun 	struct mii_data *mii;
   1432   1.1    itojun 	int s;
   1433   1.1    itojun 
   1434   1.1    itojun 	if (sc == NULL)
   1435   1.1    itojun 		return;
   1436   1.1    itojun 
   1437  1.31    dyoung 	DPRINTFN(0xff, ("%s: %s: enter\n", device_xname(sc->sc_dev),
   1438   1.1    itojun 			__func__));
   1439   1.1    itojun 
   1440   1.1    itojun 	if (sc->sc_dying)
   1441   1.1    itojun 		return;
   1442   1.1    itojun 
   1443   1.1    itojun 	ifp = GET_IFP(sc);
   1444   1.1    itojun 	mii = GET_MII(sc);
   1445   1.1    itojun 
   1446   1.1    itojun 	if (mii == NULL)
   1447   1.1    itojun 		return;
   1448   1.1    itojun 
   1449   1.1    itojun 	s = splnet();
   1450   1.1    itojun 
   1451   1.1    itojun 	mii_tick(mii);
   1452   1.1    itojun 	if (!sc->sc_link) {
   1453   1.1    itojun 		mii_pollstat(mii);
   1454   1.1    itojun 		if (mii->mii_media_status & IFM_ACTIVE &&
   1455   1.1    itojun 		    IFM_SUBTYPE(mii->mii_media_active) != IFM_NONE) {
   1456   1.1    itojun 			DPRINTF(("%s: %s: got link\n",
   1457  1.31    dyoung 				 device_xname(sc->sc_dev), __func__));
   1458   1.1    itojun 			sc->sc_link++;
   1459   1.1    itojun 			if (IFQ_IS_EMPTY(&ifp->if_snd) == 0)
   1460   1.1    itojun 				   udav_start(ifp);
   1461   1.1    itojun 		}
   1462   1.1    itojun 	}
   1463   1.1    itojun 
   1464  1.31    dyoung 	callout_reset(&sc->sc_stat_ch, hz, udav_tick, sc);
   1465   1.1    itojun 
   1466   1.1    itojun 	splx(s);
   1467   1.1    itojun }
   1468   1.1    itojun 
   1469   1.1    itojun /* Get exclusive access to the MII registers */
   1470   1.1    itojun Static void
   1471   1.1    itojun udav_lock_mii(struct udav_softc *sc)
   1472   1.1    itojun {
   1473  1.31    dyoung 	DPRINTFN(0xff, ("%s: %s: enter\n", device_xname(sc->sc_dev),
   1474   1.1    itojun 			__func__));
   1475   1.1    itojun 
   1476   1.1    itojun 	sc->sc_refcnt++;
   1477  1.19        ad 	mutex_enter(&sc->sc_mii_lock);
   1478   1.1    itojun }
   1479   1.1    itojun 
   1480   1.1    itojun Static void
   1481   1.1    itojun udav_unlock_mii(struct udav_softc *sc)
   1482   1.1    itojun {
   1483  1.31    dyoung 	DPRINTFN(0xff, ("%s: %s: enter\n", device_xname(sc->sc_dev),
   1484   1.1    itojun 		       __func__));
   1485   1.1    itojun 
   1486  1.19        ad 	mutex_exit(&sc->sc_mii_lock);
   1487   1.1    itojun 	if (--sc->sc_refcnt < 0)
   1488  1.36       mrg 		usb_detach_wakeupold(sc->sc_dev);
   1489   1.1    itojun }
   1490   1.1    itojun 
   1491   1.1    itojun Static int
   1492  1.56   msaitoh udav_miibus_readreg(device_t dev, int phy, int reg, uint16_t *val)
   1493   1.1    itojun {
   1494   1.1    itojun 	struct udav_softc *sc;
   1495  1.56   msaitoh 	uint8_t data[2];
   1496   1.1    itojun 
   1497   1.1    itojun 	if (dev == NULL)
   1498  1.56   msaitoh 		return -1;
   1499   1.1    itojun 
   1500  1.31    dyoung 	sc = device_private(dev);
   1501   1.1    itojun 
   1502   1.1    itojun 	DPRINTFN(0xff, ("%s: %s: enter, phy=%d reg=0x%04x\n",
   1503  1.31    dyoung 		 device_xname(sc->sc_dev), __func__, phy, reg));
   1504   1.1    itojun 
   1505   1.1    itojun 	if (sc->sc_dying) {
   1506   1.1    itojun #ifdef DIAGNOSTIC
   1507  1.31    dyoung 		printf("%s: %s: dying\n", device_xname(sc->sc_dev),
   1508   1.1    itojun 		       __func__);
   1509   1.1    itojun #endif
   1510  1.56   msaitoh 		return -1;
   1511   1.1    itojun 	}
   1512   1.1    itojun 
   1513   1.1    itojun 	/* XXX: one PHY only for the internal PHY */
   1514   1.1    itojun 	if (phy != 0) {
   1515   1.1    itojun 		DPRINTFN(0xff, ("%s: %s: phy=%d is not supported\n",
   1516  1.31    dyoung 			 device_xname(sc->sc_dev), __func__, phy));
   1517  1.56   msaitoh 		return -1;
   1518   1.1    itojun 	}
   1519   1.1    itojun 
   1520   1.1    itojun 	udav_lock_mii(sc);
   1521   1.1    itojun 
   1522   1.1    itojun 	/* select internal PHY and set PHY register address */
   1523   1.1    itojun 	udav_csr_write1(sc, UDAV_EPAR,
   1524   1.1    itojun 			UDAV_EPAR_PHY_ADR0 | (reg & UDAV_EPAR_EROA_MASK));
   1525   1.1    itojun 
   1526   1.1    itojun 	/* select PHY operation and start read command */
   1527   1.1    itojun 	udav_csr_write1(sc, UDAV_EPCR, UDAV_EPCR_EPOS | UDAV_EPCR_ERPRR);
   1528   1.1    itojun 
   1529   1.1    itojun 	/* XXX: should be wait? */
   1530   1.1    itojun 
   1531   1.1    itojun 	/* end read command */
   1532   1.1    itojun 	UDAV_CLRBIT(sc, UDAV_EPCR, UDAV_EPCR_ERPRR);
   1533   1.1    itojun 
   1534   1.1    itojun 	/* retrieve the result from data registers */
   1535  1.56   msaitoh 	udav_csr_read(sc, UDAV_EPDRL, data, 2);
   1536   1.1    itojun 
   1537   1.1    itojun 	udav_unlock_mii(sc);
   1538   1.1    itojun 
   1539  1.56   msaitoh 	*val = data[0] | (data[1] << 8);
   1540   1.1    itojun 
   1541  1.56   msaitoh 	DPRINTFN(0xff, ("%s: %s: phy=%d reg=0x%04x => 0x%04hx\n",
   1542  1.56   msaitoh 		device_xname(sc->sc_dev), __func__, phy, reg, *val));
   1543   1.1    itojun 
   1544  1.56   msaitoh 	return 0;
   1545   1.1    itojun }
   1546   1.1    itojun 
   1547  1.56   msaitoh Static int
   1548  1.56   msaitoh udav_miibus_writereg(device_t dev, int phy, int reg, uint16_t val)
   1549   1.1    itojun {
   1550   1.1    itojun 	struct udav_softc *sc;
   1551  1.56   msaitoh 	uint8_t data[2];
   1552   1.1    itojun 
   1553   1.1    itojun 	if (dev == NULL)
   1554  1.56   msaitoh 		return -1;
   1555   1.1    itojun 
   1556  1.31    dyoung 	sc = device_private(dev);
   1557   1.1    itojun 
   1558  1.56   msaitoh 	DPRINTFN(0xff, ("%s: %s: enter, phy=%d reg=0x%04x val=0x%04hx\n",
   1559  1.56   msaitoh 		 device_xname(sc->sc_dev), __func__, phy, reg, val));
   1560   1.1    itojun 
   1561   1.1    itojun 	if (sc->sc_dying) {
   1562   1.1    itojun #ifdef DIAGNOSTIC
   1563  1.31    dyoung 		printf("%s: %s: dying\n", device_xname(sc->sc_dev),
   1564   1.1    itojun 		       __func__);
   1565   1.1    itojun #endif
   1566  1.56   msaitoh 		return -1;
   1567   1.1    itojun 	}
   1568   1.1    itojun 
   1569   1.1    itojun 	/* XXX: one PHY only for the internal PHY */
   1570   1.1    itojun 	if (phy != 0) {
   1571   1.1    itojun 		DPRINTFN(0xff, ("%s: %s: phy=%d is not supported\n",
   1572  1.31    dyoung 			 device_xname(sc->sc_dev), __func__, phy));
   1573  1.56   msaitoh 		return -1;
   1574   1.1    itojun 	}
   1575   1.1    itojun 
   1576   1.1    itojun 	udav_lock_mii(sc);
   1577   1.1    itojun 
   1578   1.1    itojun 	/* select internal PHY and set PHY register address */
   1579   1.1    itojun 	udav_csr_write1(sc, UDAV_EPAR,
   1580   1.1    itojun 			UDAV_EPAR_PHY_ADR0 | (reg & UDAV_EPAR_EROA_MASK));
   1581   1.1    itojun 
   1582   1.1    itojun 	/* put the value to the data registers */
   1583  1.56   msaitoh 	data[0] = val & 0xff;
   1584  1.56   msaitoh 	data[1] = (val >> 8) & 0xff;
   1585  1.56   msaitoh 	udav_csr_write(sc, UDAV_EPDRL, data, 2);
   1586   1.1    itojun 
   1587   1.1    itojun 	/* select PHY operation and start write command */
   1588   1.1    itojun 	udav_csr_write1(sc, UDAV_EPCR, UDAV_EPCR_EPOS | UDAV_EPCR_ERPRW);
   1589   1.1    itojun 
   1590   1.1    itojun 	/* XXX: should be wait? */
   1591   1.1    itojun 
   1592   1.1    itojun 	/* end write command */
   1593   1.1    itojun 	UDAV_CLRBIT(sc, UDAV_EPCR, UDAV_EPCR_ERPRW);
   1594   1.1    itojun 
   1595   1.1    itojun 	udav_unlock_mii(sc);
   1596   1.1    itojun 
   1597  1.56   msaitoh 	return 0;
   1598   1.1    itojun }
   1599   1.1    itojun 
   1600   1.1    itojun Static void
   1601  1.38      matt udav_miibus_statchg(struct ifnet *ifp)
   1602   1.1    itojun {
   1603   1.1    itojun #ifdef UDAV_DEBUG
   1604   1.1    itojun 
   1605  1.38      matt 	if (ifp == NULL)
   1606   1.1    itojun 		return;
   1607   1.1    itojun 
   1608  1.38      matt 	DPRINTF(("%s: %s: enter\n", ifp->if_xname, __func__));
   1609   1.1    itojun #endif
   1610   1.1    itojun 	/* Nothing to do */
   1611   1.1    itojun }
   1612