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