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