Home | History | Annotate | Line # | Download | only in usb
if_upl.c revision 1.48
      1  1.48  riastrad /*	$NetBSD: if_upl.c,v 1.48 2015/04/13 16:33:25 riastradh Exp $	*/
      2   1.1  augustss /*
      3   1.1  augustss  * Copyright (c) 2000 The NetBSD Foundation, Inc.
      4   1.1  augustss  * All rights reserved.
      5   1.1  augustss  *
      6   1.1  augustss  * This code is derived from software contributed to The NetBSD Foundation
      7   1.3  augustss  * by Lennart Augustsson (lennart (at) augustsson.net) at
      8   1.1  augustss  * Carlstedt Research & Technology.
      9   1.1  augustss  *
     10   1.1  augustss  * Redistribution and use in source and binary forms, with or without
     11   1.1  augustss  * modification, are permitted provided that the following conditions
     12   1.1  augustss  * are met:
     13   1.1  augustss  * 1. Redistributions of source code must retain the above copyright
     14   1.1  augustss  *    notice, this list of conditions and the following disclaimer.
     15   1.1  augustss  * 2. Redistributions in binary form must reproduce the above copyright
     16   1.1  augustss  *    notice, this list of conditions and the following disclaimer in the
     17   1.1  augustss  *    documentation and/or other materials provided with the distribution.
     18   1.1  augustss  *
     19   1.1  augustss  * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
     20   1.1  augustss  * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
     21   1.1  augustss  * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
     22   1.1  augustss  * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
     23   1.1  augustss  * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
     24   1.1  augustss  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
     25   1.1  augustss  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
     26   1.1  augustss  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
     27   1.1  augustss  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
     28   1.1  augustss  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
     29   1.1  augustss  * POSSIBILITY OF SUCH DAMAGE.
     30   1.1  augustss  */
     31   1.1  augustss 
     32   1.1  augustss /*
     33   1.1  augustss  * Prolific PL2301/PL2302 driver
     34   1.1  augustss  */
     35  1.16     lukem 
     36  1.16     lukem #include <sys/cdefs.h>
     37  1.48  riastrad __KERNEL_RCSID(0, "$NetBSD: if_upl.c,v 1.48 2015/04/13 16:33:25 riastradh Exp $");
     38   1.1  augustss 
     39  1.44  christos #ifdef _KERNEL_OPT
     40   1.1  augustss #include "opt_inet.h"
     41  1.44  christos #endif
     42   1.1  augustss 
     43   1.1  augustss #include <sys/param.h>
     44   1.1  augustss #include <sys/systm.h>
     45   1.1  augustss #include <sys/callout.h>
     46   1.1  augustss #include <sys/sockio.h>
     47   1.1  augustss #include <sys/mbuf.h>
     48   1.1  augustss #include <sys/malloc.h>
     49   1.1  augustss #include <sys/kernel.h>
     50   1.1  augustss #include <sys/socket.h>
     51   1.1  augustss 
     52   1.1  augustss #include <sys/device.h>
     53  1.48  riastrad #include <sys/rndsource.h>
     54   1.1  augustss 
     55   1.1  augustss #include <net/if.h>
     56   1.1  augustss #include <net/if_types.h>
     57   1.1  augustss #include <net/if_dl.h>
     58   1.1  augustss #include <net/netisr.h>
     59   1.1  augustss 
     60   1.1  augustss #include <net/bpf.h>
     61   1.1  augustss 
     62   1.1  augustss #ifdef INET
     63  1.19  augustss #include <netinet/in.h>
     64  1.19  augustss #include <netinet/in_var.h>
     65   1.1  augustss #include <netinet/if_inarp.h>
     66   1.1  augustss #endif
     67   1.1  augustss 
     68   1.1  augustss 
     69   1.1  augustss #include <dev/usb/usb.h>
     70   1.1  augustss #include <dev/usb/usbdi.h>
     71   1.1  augustss #include <dev/usb/usbdi_util.h>
     72   1.1  augustss #include <dev/usb/usbdevs.h>
     73   1.1  augustss 
     74   1.1  augustss /*
     75   1.1  augustss  * 7  6  5  4  3  2  1  0
     76   1.6  augustss  * tx rx 1  0
     77   1.1  augustss  * 1110 0000 rxdata
     78   1.1  augustss  * 1010 0000 idle
     79   1.1  augustss  * 0010 0000 tx over
     80   1.1  augustss  * 0110      tx over + rxd
     81   1.1  augustss  */
     82   1.1  augustss 
     83   1.1  augustss #define UPL_RXDATA		0x40
     84   1.1  augustss #define UPL_TXOK		0x80
     85   1.1  augustss 
     86   1.1  augustss #define UPL_INTR_PKTLEN		1
     87   1.1  augustss 
     88   1.1  augustss #define UPL_CONFIG_NO		1
     89   1.1  augustss #define UPL_IFACE_IDX		0
     90   1.1  augustss 
     91   1.1  augustss /***/
     92   1.1  augustss 
     93   1.1  augustss #define UPL_INTR_INTERVAL	20
     94   1.1  augustss 
     95   1.1  augustss #define UPL_BUFSZ		1024
     96   1.1  augustss 
     97   1.1  augustss #define UPL_RX_FRAMES		1
     98   1.1  augustss #define UPL_TX_FRAMES		1
     99   1.1  augustss 
    100   1.1  augustss #define UPL_RX_LIST_CNT		1
    101   1.1  augustss #define UPL_TX_LIST_CNT		1
    102   1.1  augustss 
    103   1.1  augustss #define UPL_ENDPT_RX		0x0
    104   1.1  augustss #define UPL_ENDPT_TX		0x1
    105   1.1  augustss #define UPL_ENDPT_INTR		0x2
    106   1.1  augustss #define UPL_ENDPT_MAX		0x3
    107   1.1  augustss 
    108   1.1  augustss struct upl_type {
    109   1.1  augustss 	u_int16_t		upl_vid;
    110   1.1  augustss 	u_int16_t		upl_did;
    111   1.1  augustss };
    112   1.1  augustss 
    113   1.1  augustss struct upl_softc;
    114   1.1  augustss 
    115   1.1  augustss struct upl_chain {
    116   1.1  augustss 	struct upl_softc	*upl_sc;
    117   1.1  augustss 	usbd_xfer_handle	upl_xfer;
    118   1.1  augustss 	char			*upl_buf;
    119   1.1  augustss 	struct mbuf		*upl_mbuf;
    120   1.1  augustss 	int			upl_idx;
    121   1.1  augustss };
    122   1.1  augustss 
    123   1.1  augustss struct upl_cdata {
    124   1.1  augustss 	struct upl_chain	upl_tx_chain[UPL_TX_LIST_CNT];
    125   1.1  augustss 	struct upl_chain	upl_rx_chain[UPL_RX_LIST_CNT];
    126   1.1  augustss 	int			upl_tx_prod;
    127   1.1  augustss 	int			upl_tx_cons;
    128   1.1  augustss 	int			upl_tx_cnt;
    129   1.1  augustss 	int			upl_rx_prod;
    130   1.1  augustss };
    131   1.1  augustss 
    132   1.1  augustss struct upl_softc {
    133  1.38    dyoung 	device_t		sc_dev;
    134   1.1  augustss 
    135   1.1  augustss 	struct ifnet		sc_if;
    136  1.39       tls 	krndsource_t	sc_rnd_source;
    137   1.1  augustss 
    138  1.38    dyoung 	struct callout		sc_stat_ch;
    139   1.1  augustss 
    140   1.1  augustss 	usbd_device_handle	sc_udev;
    141   1.1  augustss 	usbd_interface_handle	sc_iface;
    142   1.1  augustss 	u_int16_t		sc_vendor;
    143   1.1  augustss 	u_int16_t		sc_product;
    144   1.1  augustss 	int			sc_ed[UPL_ENDPT_MAX];
    145   1.1  augustss 	usbd_pipe_handle	sc_ep[UPL_ENDPT_MAX];
    146   1.1  augustss 	struct upl_cdata	sc_cdata;
    147   1.1  augustss 
    148   1.1  augustss 	uByte			sc_ibuf;
    149   1.1  augustss 
    150   1.1  augustss 	char			sc_dying;
    151   1.1  augustss 	char			sc_attached;
    152   1.1  augustss 	u_int			sc_rx_errs;
    153   1.1  augustss 	struct timeval		sc_rx_notice;
    154   1.1  augustss 	u_int			sc_intr_errs;
    155   1.1  augustss };
    156   1.1  augustss 
    157   1.1  augustss #ifdef UPL_DEBUG
    158  1.38    dyoung #define DPRINTF(x)	if (upldebug) printf x
    159  1.38    dyoung #define DPRINTFN(n,x)	if (upldebug >= (n)) printf x
    160   1.1  augustss int	upldebug = 0;
    161   1.1  augustss #else
    162   1.1  augustss #define DPRINTF(x)
    163   1.1  augustss #define DPRINTFN(n,x)
    164   1.1  augustss #endif
    165   1.1  augustss 
    166   1.1  augustss /*
    167   1.1  augustss  * Various supported device vendors/products.
    168   1.1  augustss  */
    169   1.1  augustss Static struct upl_type sc_devs[] = {
    170   1.1  augustss 	{ USB_VENDOR_PROLIFIC, USB_PRODUCT_PROLIFIC_PL2301 },
    171   1.1  augustss 	{ USB_VENDOR_PROLIFIC, USB_PRODUCT_PROLIFIC_PL2302 },
    172   1.1  augustss 	{ 0, 0 }
    173   1.1  augustss };
    174   1.1  augustss 
    175  1.38    dyoung int             upl_match(device_t, cfdata_t, void *);
    176  1.38    dyoung void            upl_attach(device_t, device_t, void *);
    177  1.38    dyoung int             upl_detach(device_t, int);
    178  1.38    dyoung int             upl_activate(device_t, enum devact);
    179  1.38    dyoung extern struct cfdriver upl_cd;
    180  1.38    dyoung CFATTACH_DECL_NEW(upl, sizeof(struct upl_softc), upl_match, upl_attach, upl_detach, upl_activate);
    181   1.1  augustss 
    182   1.4  augustss Static int upl_openpipes(struct upl_softc *);
    183   1.4  augustss Static int upl_tx_list_init(struct upl_softc *);
    184   1.4  augustss Static int upl_rx_list_init(struct upl_softc *);
    185   1.4  augustss Static int upl_newbuf(struct upl_softc *, struct upl_chain *, struct mbuf *);
    186   1.4  augustss Static int upl_send(struct upl_softc *, struct mbuf *, int);
    187   1.4  augustss Static void upl_intr(usbd_xfer_handle, usbd_private_handle, usbd_status);
    188   1.4  augustss Static void upl_rxeof(usbd_xfer_handle, usbd_private_handle, usbd_status);
    189   1.4  augustss Static void upl_txeof(usbd_xfer_handle, usbd_private_handle, usbd_status);
    190   1.4  augustss Static void upl_start(struct ifnet *);
    191  1.28  christos Static int upl_ioctl(struct ifnet *, u_long, void *);
    192   1.4  augustss Static void upl_init(void *);
    193   1.4  augustss Static void upl_stop(struct upl_softc *);
    194   1.4  augustss Static void upl_watchdog(struct ifnet *);
    195   1.4  augustss 
    196  1.27    dyoung Static int upl_output(struct ifnet *, struct mbuf *, const struct sockaddr *,
    197   1.4  augustss 		      struct rtentry *);
    198   1.4  augustss Static void upl_input(struct ifnet *, struct mbuf *);
    199   1.1  augustss 
    200   1.1  augustss /*
    201   1.1  augustss  * Probe for a Prolific chip.
    202   1.1  augustss  */
    203  1.44  christos int
    204  1.38    dyoung upl_match(device_t parent, cfdata_t match, void *aux)
    205   1.1  augustss {
    206  1.38    dyoung 	struct usb_attach_arg *uaa = aux;
    207   1.1  augustss 	struct upl_type			*t;
    208   1.1  augustss 
    209   1.1  augustss 	for (t = sc_devs; t->upl_vid != 0; t++)
    210   1.1  augustss 		if (uaa->vendor == t->upl_vid && uaa->product == t->upl_did)
    211   1.1  augustss 			return (UMATCH_VENDOR_PRODUCT);
    212   1.1  augustss 
    213   1.1  augustss 	return (UMATCH_NONE);
    214   1.1  augustss }
    215   1.1  augustss 
    216  1.44  christos void
    217  1.38    dyoung upl_attach(device_t parent, device_t self, void *aux)
    218   1.1  augustss {
    219  1.38    dyoung 	struct upl_softc *sc = device_private(self);
    220  1.38    dyoung 	struct usb_attach_arg *uaa = aux;
    221  1.22  augustss 	char			*devinfop;
    222   1.1  augustss 	int			s;
    223   1.1  augustss 	usbd_device_handle	dev = uaa->device;
    224   1.1  augustss 	usbd_interface_handle	iface;
    225   1.1  augustss 	usbd_status		err;
    226   1.1  augustss 	struct ifnet		*ifp;
    227   1.1  augustss 	usb_interface_descriptor_t	*id;
    228   1.1  augustss 	usb_endpoint_descriptor_t	*ed;
    229   1.1  augustss 	int			i;
    230   1.1  augustss 
    231   1.1  augustss 	DPRINTFN(5,(" : upl_attach: sc=%p, dev=%p", sc, dev));
    232   1.1  augustss 
    233  1.32      cube 	sc->sc_dev = self;
    234  1.32      cube 
    235  1.34    plunky 	aprint_naive("\n");
    236  1.34    plunky 	aprint_normal("\n");
    237  1.34    plunky 
    238  1.22  augustss 	devinfop = usbd_devinfo_alloc(dev, 0);
    239  1.32      cube 	aprint_normal_dev(self, "%s\n", devinfop);
    240  1.22  augustss 	usbd_devinfo_free(devinfop);
    241   1.1  augustss 
    242   1.9  augustss 	err = usbd_set_config_no(dev, UPL_CONFIG_NO, 1);
    243   1.1  augustss 	if (err) {
    244  1.43     skrll 		aprint_error_dev(self, "failed to set configuration"
    245  1.43     skrll 		    ", err=%s\n", usbd_errstr(err));
    246  1.38    dyoung 		return;
    247   1.1  augustss 	}
    248   1.1  augustss 
    249   1.1  augustss 	sc->sc_udev = dev;
    250   1.1  augustss 	sc->sc_product = uaa->product;
    251   1.1  augustss 	sc->sc_vendor = uaa->vendor;
    252   1.1  augustss 
    253   1.1  augustss 	err = usbd_device2interface_handle(dev, UPL_IFACE_IDX, &iface);
    254   1.1  augustss 	if (err) {
    255  1.32      cube 		aprint_error_dev(self, "getting interface handle failed\n");
    256  1.38    dyoung 		return;
    257   1.1  augustss 	}
    258   1.1  augustss 
    259   1.1  augustss 	sc->sc_iface = iface;
    260   1.1  augustss 	id = usbd_get_interface_descriptor(iface);
    261   1.1  augustss 
    262   1.1  augustss 	/* Find endpoints. */
    263   1.1  augustss 	for (i = 0; i < id->bNumEndpoints; i++) {
    264   1.1  augustss 		ed = usbd_interface2endpoint_descriptor(iface, i);
    265   1.1  augustss 		if (ed == NULL) {
    266  1.32      cube 			aprint_error_dev(self, "couldn't get ep %d\n", i);
    267  1.38    dyoung 			return;
    268   1.1  augustss 		}
    269   1.1  augustss 		if (UE_GET_DIR(ed->bEndpointAddress) == UE_DIR_IN &&
    270   1.1  augustss 		    UE_GET_XFERTYPE(ed->bmAttributes) == UE_BULK) {
    271   1.1  augustss 			sc->sc_ed[UPL_ENDPT_RX] = ed->bEndpointAddress;
    272   1.1  augustss 		} else if (UE_GET_DIR(ed->bEndpointAddress) == UE_DIR_OUT &&
    273   1.1  augustss 			   UE_GET_XFERTYPE(ed->bmAttributes) == UE_BULK) {
    274   1.1  augustss 			sc->sc_ed[UPL_ENDPT_TX] = ed->bEndpointAddress;
    275   1.1  augustss 		} else if (UE_GET_DIR(ed->bEndpointAddress) == UE_DIR_IN &&
    276   1.1  augustss 			   UE_GET_XFERTYPE(ed->bmAttributes) == UE_INTERRUPT) {
    277   1.1  augustss 			sc->sc_ed[UPL_ENDPT_INTR] = ed->bEndpointAddress;
    278   1.1  augustss 		}
    279   1.1  augustss 	}
    280   1.1  augustss 
    281   1.1  augustss 	if (sc->sc_ed[UPL_ENDPT_RX] == 0 || sc->sc_ed[UPL_ENDPT_TX] == 0 ||
    282   1.1  augustss 	    sc->sc_ed[UPL_ENDPT_INTR] == 0) {
    283  1.32      cube 		aprint_error_dev(self, "missing endpoint\n");
    284  1.38    dyoung 		return;
    285   1.1  augustss 	}
    286   1.1  augustss 
    287  1.14   thorpej 	s = splnet();
    288   1.1  augustss 
    289   1.1  augustss 	/* Initialize interface info.*/
    290   1.1  augustss 	ifp = &sc->sc_if;
    291   1.1  augustss 	ifp->if_softc = sc;
    292   1.1  augustss 	ifp->if_mtu = UPL_BUFSZ;
    293   1.1  augustss 	ifp->if_flags = IFF_POINTOPOINT | IFF_NOARP | IFF_SIMPLEX;
    294   1.1  augustss 	ifp->if_ioctl = upl_ioctl;
    295   1.1  augustss 	ifp->if_start = upl_start;
    296   1.1  augustss 	ifp->if_watchdog = upl_watchdog;
    297  1.38    dyoung 	strncpy(ifp->if_xname, device_xname(sc->sc_dev), IFNAMSIZ);
    298   1.1  augustss 
    299   1.1  augustss 	ifp->if_type = IFT_OTHER;
    300   1.1  augustss 	ifp->if_addrlen = 0;
    301   1.1  augustss 	ifp->if_hdrlen = 0;
    302   1.1  augustss 	ifp->if_output = upl_output;
    303   1.1  augustss 	ifp->if_input = upl_input;
    304   1.1  augustss 	ifp->if_baudrate = 12000000;
    305  1.12  augustss 	ifp->if_dlt = DLT_RAW;
    306  1.17    itojun 	IFQ_SET_READY(&ifp->if_snd);
    307   1.1  augustss 
    308   1.1  augustss 	/* Attach the interface. */
    309   1.1  augustss 	if_attach(ifp);
    310  1.12  augustss 	if_alloc_sadl(ifp);
    311   1.1  augustss 
    312  1.37     joerg 	bpf_attach(ifp, DLT_RAW, 0);
    313  1.38    dyoung 	rnd_attach_source(&sc->sc_rnd_source, device_xname(sc->sc_dev),
    314  1.47       tls 	    RND_TYPE_NET, RND_FLAG_DEFAULT);
    315   1.1  augustss 
    316   1.1  augustss 	sc->sc_attached = 1;
    317   1.1  augustss 	splx(s);
    318   1.1  augustss 
    319   1.1  augustss 	usbd_add_drv_event(USB_EVENT_DRIVER_ATTACH, sc->sc_udev,
    320  1.38    dyoung 	    sc->sc_dev);
    321   1.1  augustss 
    322  1.38    dyoung 	return;
    323   1.1  augustss }
    324   1.1  augustss 
    325  1.44  christos int
    326  1.38    dyoung upl_detach(device_t self, int flags)
    327   1.1  augustss {
    328  1.38    dyoung 	struct upl_softc *sc = device_private(self);
    329   1.1  augustss 	struct ifnet		*ifp = &sc->sc_if;
    330   1.1  augustss 	int			s;
    331   1.1  augustss 
    332  1.38    dyoung 	DPRINTFN(2,("%s: %s: enter\n", device_xname(sc->sc_dev), __func__));
    333   1.1  augustss 
    334   1.1  augustss 	s = splusb();
    335   1.1  augustss 
    336   1.1  augustss 	if (!sc->sc_attached) {
    337   1.1  augustss 		/* Detached before attached finished, so just bail out. */
    338   1.1  augustss 		splx(s);
    339   1.1  augustss 		return (0);
    340   1.1  augustss 	}
    341   1.1  augustss 
    342   1.1  augustss 	if (ifp->if_flags & IFF_RUNNING)
    343   1.1  augustss 		upl_stop(sc);
    344   1.1  augustss 
    345   1.1  augustss 	rnd_detach_source(&sc->sc_rnd_source);
    346  1.37     joerg 	bpf_detach(ifp);
    347   1.1  augustss 
    348   1.1  augustss 	if_detach(ifp);
    349   1.1  augustss 
    350   1.1  augustss #ifdef DIAGNOSTIC
    351   1.1  augustss 	if (sc->sc_ep[UPL_ENDPT_TX] != NULL ||
    352   1.1  augustss 	    sc->sc_ep[UPL_ENDPT_RX] != NULL ||
    353   1.1  augustss 	    sc->sc_ep[UPL_ENDPT_INTR] != NULL)
    354  1.32      cube 		aprint_debug_dev(self, "detach has active endpoints\n");
    355   1.1  augustss #endif
    356   1.1  augustss 
    357   1.1  augustss 	sc->sc_attached = 0;
    358   1.1  augustss 	splx(s);
    359   1.1  augustss 
    360   1.1  augustss 	usbd_add_drv_event(USB_EVENT_DRIVER_DETACH, sc->sc_udev,
    361  1.38    dyoung 	    sc->sc_dev);
    362   1.1  augustss 
    363   1.1  augustss 	return (0);
    364   1.1  augustss }
    365   1.1  augustss 
    366   1.1  augustss int
    367  1.38    dyoung upl_activate(device_t self, enum devact act)
    368   1.1  augustss {
    369  1.32      cube 	struct upl_softc *sc = device_private(self);
    370   1.1  augustss 
    371  1.38    dyoung 	DPRINTFN(2,("%s: %s: enter\n", device_xname(sc->sc_dev), __func__));
    372   1.1  augustss 
    373   1.1  augustss 	switch (act) {
    374   1.1  augustss 	case DVACT_DEACTIVATE:
    375   1.1  augustss 		/* Deactivate the interface. */
    376   1.1  augustss 		if_deactivate(&sc->sc_if);
    377   1.1  augustss 		sc->sc_dying = 1;
    378  1.35    dyoung 		return 0;
    379  1.35    dyoung 	default:
    380  1.35    dyoung 		return EOPNOTSUPP;
    381   1.1  augustss 	}
    382   1.1  augustss }
    383   1.1  augustss 
    384   1.1  augustss /*
    385   1.1  augustss  * Initialize an RX descriptor and attach an MBUF cluster.
    386   1.1  augustss  */
    387   1.1  augustss Static int
    388   1.4  augustss upl_newbuf(struct upl_softc *sc, struct upl_chain *c, struct mbuf *m)
    389   1.1  augustss {
    390   1.1  augustss 	struct mbuf		*m_new = NULL;
    391   1.1  augustss 
    392  1.38    dyoung 	DPRINTFN(8,("%s: %s: enter\n", device_xname(sc->sc_dev), __func__));
    393   1.1  augustss 
    394   1.1  augustss 	if (m == NULL) {
    395   1.1  augustss 		MGETHDR(m_new, M_DONTWAIT, MT_DATA);
    396   1.1  augustss 		if (m_new == NULL) {
    397   1.1  augustss 			printf("%s: no memory for rx list "
    398  1.38    dyoung 			    "-- packet dropped!\n", device_xname(sc->sc_dev));
    399   1.1  augustss 			return (ENOBUFS);
    400   1.1  augustss 		}
    401   1.1  augustss 
    402   1.1  augustss 		MCLGET(m_new, M_DONTWAIT);
    403   1.1  augustss 		if (!(m_new->m_flags & M_EXT)) {
    404   1.1  augustss 			printf("%s: no memory for rx list "
    405  1.38    dyoung 			    "-- packet dropped!\n", device_xname(sc->sc_dev));
    406   1.1  augustss 			m_freem(m_new);
    407   1.1  augustss 			return (ENOBUFS);
    408   1.1  augustss 		}
    409   1.1  augustss 		m_new->m_len = m_new->m_pkthdr.len = MCLBYTES;
    410   1.1  augustss 	} else {
    411   1.1  augustss 		m_new = m;
    412   1.1  augustss 		m_new->m_len = m_new->m_pkthdr.len = MCLBYTES;
    413   1.1  augustss 		m_new->m_data = m_new->m_ext.ext_buf;
    414   1.1  augustss 	}
    415   1.1  augustss 
    416   1.1  augustss 	c->upl_mbuf = m_new;
    417   1.1  augustss 
    418   1.1  augustss 	return (0);
    419   1.1  augustss }
    420   1.1  augustss 
    421   1.1  augustss Static int
    422   1.4  augustss upl_rx_list_init(struct upl_softc *sc)
    423   1.1  augustss {
    424   1.1  augustss 	struct upl_cdata	*cd;
    425   1.1  augustss 	struct upl_chain	*c;
    426   1.1  augustss 	int			i;
    427   1.1  augustss 
    428  1.38    dyoung 	DPRINTFN(5,("%s: %s: enter\n", device_xname(sc->sc_dev), __func__));
    429   1.1  augustss 
    430   1.1  augustss 	cd = &sc->sc_cdata;
    431   1.1  augustss 	for (i = 0; i < UPL_RX_LIST_CNT; i++) {
    432   1.1  augustss 		c = &cd->upl_rx_chain[i];
    433   1.1  augustss 		c->upl_sc = sc;
    434   1.1  augustss 		c->upl_idx = i;
    435   1.1  augustss 		if (upl_newbuf(sc, c, NULL) == ENOBUFS)
    436   1.1  augustss 			return (ENOBUFS);
    437   1.1  augustss 		if (c->upl_xfer == NULL) {
    438   1.1  augustss 			c->upl_xfer = usbd_alloc_xfer(sc->sc_udev);
    439   1.1  augustss 			if (c->upl_xfer == NULL)
    440   1.1  augustss 				return (ENOBUFS);
    441   1.1  augustss 			c->upl_buf = usbd_alloc_buffer(c->upl_xfer, UPL_BUFSZ);
    442   1.1  augustss 			if (c->upl_buf == NULL) {
    443   1.1  augustss 				usbd_free_xfer(c->upl_xfer);
    444   1.1  augustss 				return (ENOBUFS);
    445   1.1  augustss 			}
    446   1.1  augustss 		}
    447   1.1  augustss 	}
    448   1.1  augustss 
    449   1.1  augustss 	return (0);
    450   1.1  augustss }
    451   1.1  augustss 
    452   1.1  augustss Static int
    453   1.4  augustss upl_tx_list_init(struct upl_softc *sc)
    454   1.1  augustss {
    455   1.1  augustss 	struct upl_cdata	*cd;
    456   1.1  augustss 	struct upl_chain	*c;
    457   1.1  augustss 	int			i;
    458   1.1  augustss 
    459  1.38    dyoung 	DPRINTFN(5,("%s: %s: enter\n", device_xname(sc->sc_dev), __func__));
    460   1.1  augustss 
    461   1.1  augustss 	cd = &sc->sc_cdata;
    462   1.1  augustss 	for (i = 0; i < UPL_TX_LIST_CNT; i++) {
    463   1.1  augustss 		c = &cd->upl_tx_chain[i];
    464   1.1  augustss 		c->upl_sc = sc;
    465   1.1  augustss 		c->upl_idx = i;
    466   1.1  augustss 		c->upl_mbuf = NULL;
    467   1.1  augustss 		if (c->upl_xfer == NULL) {
    468   1.1  augustss 			c->upl_xfer = usbd_alloc_xfer(sc->sc_udev);
    469   1.1  augustss 			if (c->upl_xfer == NULL)
    470   1.1  augustss 				return (ENOBUFS);
    471   1.1  augustss 			c->upl_buf = usbd_alloc_buffer(c->upl_xfer, UPL_BUFSZ);
    472   1.1  augustss 			if (c->upl_buf == NULL) {
    473   1.1  augustss 				usbd_free_xfer(c->upl_xfer);
    474   1.1  augustss 				return (ENOBUFS);
    475   1.1  augustss 			}
    476   1.1  augustss 		}
    477   1.1  augustss 	}
    478   1.1  augustss 
    479   1.1  augustss 	return (0);
    480   1.1  augustss }
    481   1.1  augustss 
    482   1.1  augustss /*
    483   1.1  augustss  * A frame has been uploaded: pass the resulting mbuf chain up to
    484   1.1  augustss  * the higher level protocols.
    485   1.1  augustss  */
    486   1.1  augustss Static void
    487   1.4  augustss upl_rxeof(usbd_xfer_handle xfer, usbd_private_handle priv, usbd_status status)
    488   1.1  augustss {
    489   1.1  augustss 	struct upl_chain	*c = priv;
    490   1.1  augustss 	struct upl_softc	*sc = c->upl_sc;
    491   1.1  augustss 	struct ifnet		*ifp = &sc->sc_if;
    492   1.1  augustss 	struct mbuf		*m;
    493   1.1  augustss 	int			total_len = 0;
    494   1.1  augustss 	int			s;
    495   1.1  augustss 
    496   1.1  augustss 	if (sc->sc_dying)
    497   1.1  augustss 		return;
    498   1.1  augustss 
    499   1.1  augustss 	if (!(ifp->if_flags & IFF_RUNNING))
    500   1.1  augustss 		return;
    501   1.1  augustss 
    502   1.1  augustss 	if (status != USBD_NORMAL_COMPLETION) {
    503   1.1  augustss 		if (status == USBD_NOT_STARTED || status == USBD_CANCELLED)
    504   1.1  augustss 			return;
    505   1.1  augustss 		sc->sc_rx_errs++;
    506   1.1  augustss 		if (usbd_ratecheck(&sc->sc_rx_notice)) {
    507   1.1  augustss 			printf("%s: %u usb errors on rx: %s\n",
    508  1.38    dyoung 			    device_xname(sc->sc_dev), sc->sc_rx_errs,
    509   1.1  augustss 			    usbd_errstr(status));
    510   1.1  augustss 			sc->sc_rx_errs = 0;
    511   1.1  augustss 		}
    512   1.1  augustss 		if (status == USBD_STALLED)
    513  1.23  augustss 			usbd_clear_endpoint_stall_async(sc->sc_ep[UPL_ENDPT_RX]);
    514   1.1  augustss 		goto done;
    515   1.1  augustss 	}
    516   1.1  augustss 
    517   1.1  augustss 	usbd_get_xfer_status(xfer, NULL, NULL, &total_len, NULL);
    518   1.1  augustss 
    519   1.1  augustss 	DPRINTFN(9,("%s: %s: enter status=%d length=%d\n",
    520  1.38    dyoung 		    device_xname(sc->sc_dev), __func__, status, total_len));
    521   1.1  augustss 
    522   1.1  augustss 	m = c->upl_mbuf;
    523   1.1  augustss 	memcpy(mtod(c->upl_mbuf, char *), c->upl_buf, total_len);
    524   1.1  augustss 
    525   1.1  augustss 	ifp->if_ipackets++;
    526   1.1  augustss 	m->m_pkthdr.len = m->m_len = total_len;
    527   1.1  augustss 
    528   1.1  augustss 	m->m_pkthdr.rcvif = ifp;
    529   1.1  augustss 
    530  1.14   thorpej 	s = splnet();
    531   1.1  augustss 
    532   1.1  augustss 	/* XXX ugly */
    533   1.1  augustss 	if (upl_newbuf(sc, c, NULL) == ENOBUFS) {
    534   1.1  augustss 		ifp->if_ierrors++;
    535   1.1  augustss 		goto done1;
    536   1.1  augustss 	}
    537   1.1  augustss 
    538   1.1  augustss 	/*
    539   1.1  augustss 	 * Handle BPF listeners. Let the BPF user see the packet, but
    540   1.1  augustss 	 * don't pass it up to the ether_input() layer unless it's
    541   1.1  augustss 	 * a broadcast packet, multicast packet, matches our ethernet
    542   1.1  augustss 	 * address or the interface is in promiscuous mode.
    543   1.1  augustss 	 */
    544  1.37     joerg 	bpf_mtap(ifp, m);
    545   1.1  augustss 
    546  1.38    dyoung 	DPRINTFN(10,("%s: %s: deliver %d\n", device_xname(sc->sc_dev),
    547  1.18  augustss 		    __func__, m->m_len));
    548   1.1  augustss 
    549  1.38    dyoung 	(*(ifp)->if_input)((ifp), (m));
    550   1.1  augustss 
    551   1.1  augustss  done1:
    552   1.1  augustss 	splx(s);
    553   1.1  augustss 
    554   1.1  augustss  done:
    555   1.1  augustss #if 1
    556   1.1  augustss 	/* Setup new transfer. */
    557   1.1  augustss 	usbd_setup_xfer(c->upl_xfer, sc->sc_ep[UPL_ENDPT_RX],
    558   1.1  augustss 	    c, c->upl_buf, UPL_BUFSZ, USBD_SHORT_XFER_OK | USBD_NO_COPY,
    559   1.1  augustss 	    USBD_NO_TIMEOUT, upl_rxeof);
    560   1.1  augustss 	usbd_transfer(c->upl_xfer);
    561   1.1  augustss 
    562  1.38    dyoung 	DPRINTFN(10,("%s: %s: start rx\n", device_xname(sc->sc_dev),
    563  1.18  augustss 		    __func__));
    564   1.1  augustss #endif
    565   1.1  augustss }
    566   1.1  augustss 
    567   1.1  augustss /*
    568   1.1  augustss  * A frame was downloaded to the chip. It's safe for us to clean up
    569   1.1  augustss  * the list buffers.
    570   1.1  augustss  */
    571   1.1  augustss Static void
    572  1.26  christos upl_txeof(usbd_xfer_handle xfer, usbd_private_handle priv,
    573  1.25  christos     usbd_status status)
    574   1.1  augustss {
    575   1.1  augustss 	struct upl_chain	*c = priv;
    576   1.1  augustss 	struct upl_softc	*sc = c->upl_sc;
    577   1.1  augustss 	struct ifnet		*ifp = &sc->sc_if;
    578   1.1  augustss 	int			s;
    579   1.1  augustss 
    580   1.1  augustss 	if (sc->sc_dying)
    581   1.1  augustss 		return;
    582   1.1  augustss 
    583  1.14   thorpej 	s = splnet();
    584   1.1  augustss 
    585  1.38    dyoung 	DPRINTFN(10,("%s: %s: enter status=%d\n", device_xname(sc->sc_dev),
    586  1.18  augustss 		    __func__, status));
    587   1.1  augustss 
    588   1.1  augustss 	ifp->if_timer = 0;
    589   1.1  augustss 	ifp->if_flags &= ~IFF_OACTIVE;
    590   1.1  augustss 
    591   1.1  augustss 	if (status != USBD_NORMAL_COMPLETION) {
    592   1.1  augustss 		if (status == USBD_NOT_STARTED || status == USBD_CANCELLED) {
    593   1.1  augustss 			splx(s);
    594   1.1  augustss 			return;
    595   1.1  augustss 		}
    596   1.1  augustss 		ifp->if_oerrors++;
    597  1.38    dyoung 		printf("%s: usb error on tx: %s\n", device_xname(sc->sc_dev),
    598   1.1  augustss 		    usbd_errstr(status));
    599   1.1  augustss 		if (status == USBD_STALLED)
    600  1.23  augustss 			usbd_clear_endpoint_stall_async(sc->sc_ep[UPL_ENDPT_TX]);
    601   1.1  augustss 		splx(s);
    602   1.1  augustss 		return;
    603   1.1  augustss 	}
    604   1.1  augustss 
    605   1.1  augustss 	ifp->if_opackets++;
    606   1.1  augustss 
    607   1.1  augustss 	m_freem(c->upl_mbuf);
    608   1.1  augustss 	c->upl_mbuf = NULL;
    609   1.1  augustss 
    610  1.17    itojun 	if (IFQ_IS_EMPTY(&ifp->if_snd) == 0)
    611   1.1  augustss 		upl_start(ifp);
    612   1.1  augustss 
    613   1.1  augustss 	splx(s);
    614   1.1  augustss }
    615   1.1  augustss 
    616   1.1  augustss Static int
    617   1.4  augustss upl_send(struct upl_softc *sc, struct mbuf *m, int idx)
    618   1.1  augustss {
    619   1.1  augustss 	int			total_len;
    620   1.1  augustss 	struct upl_chain	*c;
    621   1.1  augustss 	usbd_status		err;
    622   1.1  augustss 
    623   1.1  augustss 	c = &sc->sc_cdata.upl_tx_chain[idx];
    624   1.1  augustss 
    625   1.1  augustss 	/*
    626   1.1  augustss 	 * Copy the mbuf data into a contiguous buffer, leaving two
    627   1.1  augustss 	 * bytes at the beginning to hold the frame length.
    628   1.1  augustss 	 */
    629   1.1  augustss 	m_copydata(m, 0, m->m_pkthdr.len, c->upl_buf);
    630   1.1  augustss 	c->upl_mbuf = m;
    631   1.1  augustss 
    632   1.1  augustss 	total_len = m->m_pkthdr.len;
    633   1.1  augustss 
    634   1.1  augustss 	DPRINTFN(10,("%s: %s: total_len=%d\n",
    635  1.38    dyoung 		     device_xname(sc->sc_dev), __func__, total_len));
    636   1.1  augustss 
    637   1.1  augustss 	usbd_setup_xfer(c->upl_xfer, sc->sc_ep[UPL_ENDPT_TX],
    638   1.1  augustss 	    c, c->upl_buf, total_len, USBD_NO_COPY, USBD_DEFAULT_TIMEOUT,
    639   1.1  augustss 	    upl_txeof);
    640   1.1  augustss 
    641   1.1  augustss 	/* Transmit */
    642   1.1  augustss 	err = usbd_transfer(c->upl_xfer);
    643   1.1  augustss 	if (err != USBD_IN_PROGRESS) {
    644  1.38    dyoung 		printf("%s: upl_send error=%s\n", device_xname(sc->sc_dev),
    645   1.1  augustss 		       usbd_errstr(err));
    646   1.1  augustss 		upl_stop(sc);
    647   1.1  augustss 		return (EIO);
    648   1.1  augustss 	}
    649   1.1  augustss 
    650   1.1  augustss 	sc->sc_cdata.upl_tx_cnt++;
    651   1.1  augustss 
    652   1.1  augustss 	return (0);
    653   1.1  augustss }
    654   1.1  augustss 
    655   1.1  augustss Static void
    656   1.4  augustss upl_start(struct ifnet *ifp)
    657   1.1  augustss {
    658   1.1  augustss 	struct upl_softc	*sc = ifp->if_softc;
    659   1.1  augustss 	struct mbuf		*m_head = NULL;
    660   1.1  augustss 
    661   1.1  augustss 	if (sc->sc_dying)
    662   1.1  augustss 		return;
    663   1.1  augustss 
    664  1.38    dyoung 	DPRINTFN(10,("%s: %s: enter\n", device_xname(sc->sc_dev),__func__));
    665   1.1  augustss 
    666   1.1  augustss 	if (ifp->if_flags & IFF_OACTIVE)
    667   1.1  augustss 		return;
    668   1.1  augustss 
    669  1.17    itojun 	IFQ_POLL(&ifp->if_snd, m_head);
    670   1.1  augustss 	if (m_head == NULL)
    671   1.1  augustss 		return;
    672   1.1  augustss 
    673   1.1  augustss 	if (upl_send(sc, m_head, 0)) {
    674   1.1  augustss 		ifp->if_flags |= IFF_OACTIVE;
    675   1.1  augustss 		return;
    676   1.1  augustss 	}
    677   1.1  augustss 
    678  1.17    itojun 	IFQ_DEQUEUE(&ifp->if_snd, m_head);
    679  1.17    itojun 
    680   1.1  augustss 	/*
    681   1.1  augustss 	 * If there's a BPF listener, bounce a copy of this frame
    682   1.1  augustss 	 * to him.
    683   1.1  augustss 	 */
    684  1.37     joerg 	bpf_mtap(ifp, m_head);
    685   1.1  augustss 
    686   1.1  augustss 	ifp->if_flags |= IFF_OACTIVE;
    687   1.1  augustss 
    688   1.1  augustss 	/*
    689   1.1  augustss 	 * Set a timeout in case the chip goes out to lunch.
    690   1.1  augustss 	 */
    691   1.1  augustss 	ifp->if_timer = 5;
    692   1.1  augustss }
    693   1.1  augustss 
    694   1.1  augustss Static void
    695   1.4  augustss upl_init(void *xsc)
    696   1.1  augustss {
    697   1.1  augustss 	struct upl_softc	*sc = xsc;
    698   1.1  augustss 	struct ifnet		*ifp = &sc->sc_if;
    699   1.1  augustss 	int			s;
    700   1.1  augustss 
    701   1.1  augustss 	if (sc->sc_dying)
    702   1.1  augustss 		return;
    703   1.1  augustss 
    704  1.38    dyoung 	DPRINTFN(10,("%s: %s: enter\n", device_xname(sc->sc_dev),__func__));
    705   1.1  augustss 
    706   1.1  augustss 	if (ifp->if_flags & IFF_RUNNING)
    707   1.1  augustss 		return;
    708   1.1  augustss 
    709  1.14   thorpej 	s = splnet();
    710   1.1  augustss 
    711   1.1  augustss 	/* Init TX ring. */
    712   1.1  augustss 	if (upl_tx_list_init(sc) == ENOBUFS) {
    713  1.38    dyoung 		printf("%s: tx list init failed\n", device_xname(sc->sc_dev));
    714   1.1  augustss 		splx(s);
    715   1.1  augustss 		return;
    716   1.1  augustss 	}
    717   1.1  augustss 
    718   1.1  augustss 	/* Init RX ring. */
    719   1.1  augustss 	if (upl_rx_list_init(sc) == ENOBUFS) {
    720  1.38    dyoung 		printf("%s: rx list init failed\n", device_xname(sc->sc_dev));
    721   1.1  augustss 		splx(s);
    722   1.1  augustss 		return;
    723   1.1  augustss 	}
    724   1.1  augustss 
    725   1.1  augustss 	if (sc->sc_ep[UPL_ENDPT_RX] == NULL) {
    726   1.1  augustss 		if (upl_openpipes(sc)) {
    727   1.1  augustss 			splx(s);
    728   1.1  augustss 			return;
    729   1.1  augustss 		}
    730   1.1  augustss 	}
    731   1.1  augustss 
    732   1.1  augustss 	ifp->if_flags |= IFF_RUNNING;
    733   1.1  augustss 	ifp->if_flags &= ~IFF_OACTIVE;
    734   1.1  augustss 
    735   1.1  augustss 	splx(s);
    736   1.1  augustss }
    737   1.1  augustss 
    738   1.1  augustss Static int
    739   1.4  augustss upl_openpipes(struct upl_softc *sc)
    740   1.1  augustss {
    741   1.1  augustss 	struct upl_chain	*c;
    742   1.1  augustss 	usbd_status		err;
    743   1.1  augustss 	int			i;
    744   1.1  augustss 
    745   1.1  augustss 	/* Open RX and TX pipes. */
    746   1.1  augustss 	err = usbd_open_pipe(sc->sc_iface, sc->sc_ed[UPL_ENDPT_RX],
    747   1.1  augustss 	    USBD_EXCLUSIVE_USE, &sc->sc_ep[UPL_ENDPT_RX]);
    748   1.1  augustss 	if (err) {
    749   1.1  augustss 		printf("%s: open rx pipe failed: %s\n",
    750  1.38    dyoung 		    device_xname(sc->sc_dev), usbd_errstr(err));
    751   1.1  augustss 		return (EIO);
    752   1.1  augustss 	}
    753   1.1  augustss 	err = usbd_open_pipe(sc->sc_iface, sc->sc_ed[UPL_ENDPT_TX],
    754   1.1  augustss 	    USBD_EXCLUSIVE_USE, &sc->sc_ep[UPL_ENDPT_TX]);
    755   1.1  augustss 	if (err) {
    756   1.1  augustss 		printf("%s: open tx pipe failed: %s\n",
    757  1.38    dyoung 		    device_xname(sc->sc_dev), usbd_errstr(err));
    758   1.1  augustss 		return (EIO);
    759   1.1  augustss 	}
    760   1.1  augustss 	err = usbd_open_pipe_intr(sc->sc_iface, sc->sc_ed[UPL_ENDPT_INTR],
    761   1.1  augustss 	    USBD_EXCLUSIVE_USE, &sc->sc_ep[UPL_ENDPT_INTR], sc,
    762  1.19  augustss 	    &sc->sc_ibuf, UPL_INTR_PKTLEN, upl_intr,
    763   1.1  augustss 	    UPL_INTR_INTERVAL);
    764   1.1  augustss 	if (err) {
    765   1.1  augustss 		printf("%s: open intr pipe failed: %s\n",
    766  1.38    dyoung 		    device_xname(sc->sc_dev), usbd_errstr(err));
    767   1.1  augustss 		return (EIO);
    768   1.1  augustss 	}
    769   1.1  augustss 
    770   1.1  augustss 
    771   1.1  augustss #if 1
    772   1.1  augustss 	/* Start up the receive pipe. */
    773   1.1  augustss 	for (i = 0; i < UPL_RX_LIST_CNT; i++) {
    774   1.1  augustss 		c = &sc->sc_cdata.upl_rx_chain[i];
    775   1.1  augustss 		usbd_setup_xfer(c->upl_xfer, sc->sc_ep[UPL_ENDPT_RX],
    776   1.1  augustss 		    c, c->upl_buf, UPL_BUFSZ,
    777   1.1  augustss 		    USBD_SHORT_XFER_OK | USBD_NO_COPY, USBD_NO_TIMEOUT,
    778   1.1  augustss 		    upl_rxeof);
    779   1.1  augustss 		usbd_transfer(c->upl_xfer);
    780   1.1  augustss 	}
    781   1.1  augustss #endif
    782   1.1  augustss 
    783   1.1  augustss 	return (0);
    784   1.1  augustss }
    785   1.1  augustss 
    786   1.1  augustss Static void
    787  1.26  christos upl_intr(usbd_xfer_handle xfer, usbd_private_handle priv,
    788  1.25  christos     usbd_status status)
    789   1.1  augustss {
    790   1.1  augustss 	struct upl_softc	*sc = priv;
    791   1.1  augustss 	struct ifnet		*ifp = &sc->sc_if;
    792   1.1  augustss 	uByte			stat;
    793   1.1  augustss 
    794  1.38    dyoung 	DPRINTFN(15,("%s: %s: enter\n", device_xname(sc->sc_dev),__func__));
    795   1.1  augustss 
    796   1.1  augustss 	if (sc->sc_dying)
    797   1.1  augustss 		return;
    798   1.1  augustss 
    799   1.1  augustss 	if (!(ifp->if_flags & IFF_RUNNING))
    800   1.1  augustss 		return;
    801   1.1  augustss 
    802   1.1  augustss 	if (status != USBD_NORMAL_COMPLETION) {
    803   1.1  augustss 		if (status == USBD_NOT_STARTED || status == USBD_CANCELLED) {
    804   1.1  augustss 			return;
    805   1.1  augustss 		}
    806   1.1  augustss 		sc->sc_intr_errs++;
    807   1.1  augustss 		if (usbd_ratecheck(&sc->sc_rx_notice)) {
    808   1.1  augustss 			printf("%s: %u usb errors on intr: %s\n",
    809  1.38    dyoung 			    device_xname(sc->sc_dev), sc->sc_rx_errs,
    810   1.1  augustss 			    usbd_errstr(status));
    811   1.1  augustss 			sc->sc_intr_errs = 0;
    812   1.1  augustss 		}
    813   1.1  augustss 		if (status == USBD_STALLED)
    814  1.23  augustss 			usbd_clear_endpoint_stall_async(sc->sc_ep[UPL_ENDPT_RX]);
    815   1.1  augustss 		return;
    816   1.1  augustss 	}
    817   1.1  augustss 
    818   1.1  augustss 	stat = sc->sc_ibuf;
    819   1.1  augustss 
    820   1.1  augustss 	if (stat == 0)
    821   1.1  augustss 		return;
    822   1.1  augustss 
    823  1.38    dyoung 	DPRINTFN(10,("%s: %s: stat=0x%02x\n", device_xname(sc->sc_dev),
    824  1.18  augustss 		     __func__, stat));
    825   1.1  augustss 
    826   1.1  augustss }
    827   1.1  augustss 
    828   1.1  augustss Static int
    829  1.28  christos upl_ioctl(struct ifnet *ifp, u_long command, void *data)
    830   1.1  augustss {
    831   1.1  augustss 	struct upl_softc	*sc = ifp->if_softc;
    832   1.1  augustss 	struct ifaddr 		*ifa = (struct ifaddr *)data;
    833   1.1  augustss 	struct ifreq		*ifr = (struct ifreq *)data;
    834   1.1  augustss 	int			s, error = 0;
    835   1.1  augustss 
    836   1.1  augustss 	if (sc->sc_dying)
    837   1.1  augustss 		return (EIO);
    838   1.1  augustss 
    839   1.1  augustss 	DPRINTFN(5,("%s: %s: cmd=0x%08lx\n",
    840  1.38    dyoung 		    device_xname(sc->sc_dev), __func__, command));
    841   1.1  augustss 
    842  1.14   thorpej 	s = splnet();
    843   1.1  augustss 
    844   1.1  augustss 	switch(command) {
    845  1.33    dyoung 	case SIOCINITIFADDR:
    846   1.1  augustss 		ifp->if_flags |= IFF_UP;
    847   1.1  augustss 		upl_init(sc);
    848   1.1  augustss 
    849   1.1  augustss 		switch (ifa->ifa_addr->sa_family) {
    850   1.1  augustss #ifdef INET
    851   1.1  augustss 		case AF_INET:
    852   1.1  augustss 			break;
    853   1.1  augustss #endif /* INET */
    854   1.1  augustss 		}
    855   1.1  augustss 		break;
    856   1.1  augustss 
    857   1.1  augustss 	case SIOCSIFMTU:
    858   1.1  augustss 		if (ifr->ifr_mtu > UPL_BUFSZ)
    859   1.1  augustss 			error = EINVAL;
    860  1.30    dyoung 		else if ((error = ifioctl_common(ifp, command, data)) == ENETRESET)
    861  1.30    dyoung 			error = 0;
    862   1.1  augustss 		break;
    863   1.1  augustss 
    864   1.1  augustss 	case SIOCSIFFLAGS:
    865  1.33    dyoung 		if ((error = ifioctl_common(ifp, command, data)) != 0)
    866  1.33    dyoung 			break;
    867  1.33    dyoung 		/* XXX re-use ether_ioctl() */
    868  1.33    dyoung 		switch (ifp->if_flags & (IFF_UP|IFF_RUNNING)) {
    869  1.33    dyoung 		case IFF_UP:
    870  1.33    dyoung 			upl_init(sc);
    871  1.33    dyoung 			break;
    872  1.33    dyoung 		case IFF_RUNNING:
    873  1.33    dyoung 			upl_stop(sc);
    874  1.33    dyoung 			break;
    875  1.33    dyoung 		default:
    876  1.33    dyoung 			break;
    877   1.1  augustss 		}
    878   1.1  augustss 		break;
    879   1.1  augustss 	default:
    880  1.33    dyoung 		error = ifioctl_common(ifp, command, data);
    881   1.1  augustss 		break;
    882   1.1  augustss 	}
    883   1.1  augustss 
    884   1.1  augustss 	splx(s);
    885   1.1  augustss 
    886   1.1  augustss 	return (error);
    887   1.1  augustss }
    888   1.1  augustss 
    889   1.1  augustss Static void
    890   1.4  augustss upl_watchdog(struct ifnet *ifp)
    891   1.1  augustss {
    892   1.1  augustss 	struct upl_softc	*sc = ifp->if_softc;
    893   1.1  augustss 
    894  1.38    dyoung 	DPRINTFN(5,("%s: %s: enter\n", device_xname(sc->sc_dev),__func__));
    895   1.1  augustss 
    896   1.1  augustss 	if (sc->sc_dying)
    897   1.1  augustss 		return;
    898   1.1  augustss 
    899   1.1  augustss 	ifp->if_oerrors++;
    900  1.38    dyoung 	printf("%s: watchdog timeout\n", device_xname(sc->sc_dev));
    901   1.1  augustss 
    902   1.1  augustss 	upl_stop(sc);
    903   1.1  augustss 	upl_init(sc);
    904   1.1  augustss 
    905  1.17    itojun 	if (IFQ_IS_EMPTY(&ifp->if_snd) == 0)
    906   1.1  augustss 		upl_start(ifp);
    907   1.1  augustss }
    908   1.1  augustss 
    909   1.1  augustss /*
    910   1.1  augustss  * Stop the adapter and free any mbufs allocated to the
    911   1.1  augustss  * RX and TX lists.
    912   1.1  augustss  */
    913   1.1  augustss Static void
    914   1.4  augustss upl_stop(struct upl_softc *sc)
    915   1.1  augustss {
    916   1.1  augustss 	usbd_status		err;
    917   1.1  augustss 	struct ifnet		*ifp;
    918   1.1  augustss 	int			i;
    919   1.1  augustss 
    920  1.38    dyoung 	DPRINTFN(10,("%s: %s: enter\n", device_xname(sc->sc_dev),__func__));
    921   1.1  augustss 
    922   1.1  augustss 	ifp = &sc->sc_if;
    923   1.1  augustss 	ifp->if_timer = 0;
    924   1.1  augustss 
    925   1.1  augustss 	/* Stop transfers. */
    926   1.1  augustss 	if (sc->sc_ep[UPL_ENDPT_RX] != NULL) {
    927   1.1  augustss 		err = usbd_abort_pipe(sc->sc_ep[UPL_ENDPT_RX]);
    928   1.1  augustss 		if (err) {
    929   1.1  augustss 			printf("%s: abort rx pipe failed: %s\n",
    930  1.38    dyoung 			device_xname(sc->sc_dev), usbd_errstr(err));
    931   1.1  augustss 		}
    932   1.1  augustss 		err = usbd_close_pipe(sc->sc_ep[UPL_ENDPT_RX]);
    933   1.1  augustss 		if (err) {
    934   1.1  augustss 			printf("%s: close rx pipe failed: %s\n",
    935  1.38    dyoung 			device_xname(sc->sc_dev), usbd_errstr(err));
    936   1.1  augustss 		}
    937   1.1  augustss 		sc->sc_ep[UPL_ENDPT_RX] = NULL;
    938   1.1  augustss 	}
    939   1.1  augustss 
    940   1.1  augustss 	if (sc->sc_ep[UPL_ENDPT_TX] != NULL) {
    941   1.1  augustss 		err = usbd_abort_pipe(sc->sc_ep[UPL_ENDPT_TX]);
    942   1.1  augustss 		if (err) {
    943   1.1  augustss 			printf("%s: abort tx pipe failed: %s\n",
    944  1.38    dyoung 			device_xname(sc->sc_dev), usbd_errstr(err));
    945   1.1  augustss 		}
    946   1.1  augustss 		err = usbd_close_pipe(sc->sc_ep[UPL_ENDPT_TX]);
    947   1.1  augustss 		if (err) {
    948   1.1  augustss 			printf("%s: close tx pipe failed: %s\n",
    949  1.38    dyoung 			    device_xname(sc->sc_dev), usbd_errstr(err));
    950   1.1  augustss 		}
    951   1.1  augustss 		sc->sc_ep[UPL_ENDPT_TX] = NULL;
    952   1.1  augustss 	}
    953   1.1  augustss 
    954   1.1  augustss 	if (sc->sc_ep[UPL_ENDPT_INTR] != NULL) {
    955   1.1  augustss 		err = usbd_abort_pipe(sc->sc_ep[UPL_ENDPT_INTR]);
    956   1.1  augustss 		if (err) {
    957   1.1  augustss 			printf("%s: abort intr pipe failed: %s\n",
    958  1.38    dyoung 			device_xname(sc->sc_dev), usbd_errstr(err));
    959   1.1  augustss 		}
    960   1.1  augustss 		err = usbd_close_pipe(sc->sc_ep[UPL_ENDPT_INTR]);
    961   1.1  augustss 		if (err) {
    962   1.1  augustss 			printf("%s: close intr pipe failed: %s\n",
    963  1.38    dyoung 			    device_xname(sc->sc_dev), usbd_errstr(err));
    964   1.1  augustss 		}
    965   1.1  augustss 		sc->sc_ep[UPL_ENDPT_INTR] = NULL;
    966   1.1  augustss 	}
    967   1.1  augustss 
    968   1.1  augustss 	/* Free RX resources. */
    969   1.1  augustss 	for (i = 0; i < UPL_RX_LIST_CNT; i++) {
    970   1.1  augustss 		if (sc->sc_cdata.upl_rx_chain[i].upl_mbuf != NULL) {
    971   1.1  augustss 			m_freem(sc->sc_cdata.upl_rx_chain[i].upl_mbuf);
    972   1.1  augustss 			sc->sc_cdata.upl_rx_chain[i].upl_mbuf = NULL;
    973   1.1  augustss 		}
    974   1.1  augustss 		if (sc->sc_cdata.upl_rx_chain[i].upl_xfer != NULL) {
    975   1.1  augustss 			usbd_free_xfer(sc->sc_cdata.upl_rx_chain[i].upl_xfer);
    976   1.1  augustss 			sc->sc_cdata.upl_rx_chain[i].upl_xfer = NULL;
    977   1.1  augustss 		}
    978   1.1  augustss 	}
    979   1.1  augustss 
    980   1.1  augustss 	/* Free TX resources. */
    981   1.1  augustss 	for (i = 0; i < UPL_TX_LIST_CNT; i++) {
    982   1.1  augustss 		if (sc->sc_cdata.upl_tx_chain[i].upl_mbuf != NULL) {
    983   1.1  augustss 			m_freem(sc->sc_cdata.upl_tx_chain[i].upl_mbuf);
    984   1.1  augustss 			sc->sc_cdata.upl_tx_chain[i].upl_mbuf = NULL;
    985   1.1  augustss 		}
    986   1.1  augustss 		if (sc->sc_cdata.upl_tx_chain[i].upl_xfer != NULL) {
    987   1.1  augustss 			usbd_free_xfer(sc->sc_cdata.upl_tx_chain[i].upl_xfer);
    988   1.1  augustss 			sc->sc_cdata.upl_tx_chain[i].upl_xfer = NULL;
    989   1.1  augustss 		}
    990   1.1  augustss 	}
    991   1.1  augustss 
    992   1.1  augustss 	ifp->if_flags &= ~(IFF_RUNNING | IFF_OACTIVE);
    993   1.1  augustss }
    994   1.1  augustss 
    995   1.1  augustss Static int
    996  1.27    dyoung upl_output(struct ifnet *ifp, struct mbuf *m, const struct sockaddr *dst,
    997  1.26  christos     struct rtentry *rt0)
    998   1.1  augustss {
    999  1.17    itojun 	int s, len, error;
   1000  1.17    itojun 	ALTQ_DECL(struct altq_pktattr pktattr;)
   1001   1.1  augustss 
   1002   1.1  augustss 	DPRINTFN(10,("%s: %s: enter\n",
   1003  1.38    dyoung 		     device_xname(((struct upl_softc *)ifp->if_softc)->sc_dev),
   1004  1.18  augustss 		     __func__));
   1005   1.1  augustss 
   1006  1.17    itojun 	/*
   1007  1.17    itojun 	 * if the queueing discipline needs packet classification,
   1008  1.17    itojun 	 * do it now.
   1009  1.17    itojun 	 */
   1010  1.17    itojun 	IFQ_CLASSIFY(&ifp->if_snd, m, dst->sa_family, &pktattr);
   1011  1.17    itojun 
   1012  1.17    itojun 	len = m->m_pkthdr.len;
   1013  1.14   thorpej 	s = splnet();
   1014   1.1  augustss 	/*
   1015   1.1  augustss 	 * Queue message on interface, and start output if interface
   1016   1.1  augustss 	 * not yet active.
   1017   1.1  augustss 	 */
   1018  1.17    itojun 	IFQ_ENQUEUE(&ifp->if_snd, m, &pktattr, error);
   1019  1.17    itojun 	if (error) {
   1020  1.17    itojun 		/* mbuf is already freed */
   1021   1.1  augustss 		splx(s);
   1022  1.17    itojun 		return (error);
   1023   1.1  augustss 	}
   1024  1.17    itojun 	ifp->if_obytes += len;
   1025   1.1  augustss 	if ((ifp->if_flags & IFF_OACTIVE) == 0)
   1026   1.1  augustss 		(*ifp->if_start)(ifp);
   1027   1.1  augustss 	splx(s);
   1028   1.1  augustss 
   1029   1.1  augustss 	return (0);
   1030   1.1  augustss }
   1031   1.1  augustss 
   1032   1.1  augustss Static void
   1033   1.4  augustss upl_input(struct ifnet *ifp, struct mbuf *m)
   1034   1.1  augustss {
   1035  1.21  christos #ifdef INET
   1036  1.46     rmind 	size_t pktlen = m->m_len;
   1037   1.1  augustss 	int s;
   1038   1.1  augustss 
   1039  1.14   thorpej 	s = splnet();
   1040  1.46     rmind 	if (__predict_false(!pktq_enqueue(ip_pktq, m, 0))) {
   1041   1.1  augustss 		ifp->if_iqdrops++;
   1042  1.46     rmind 		m_freem(m);
   1043  1.46     rmind 	} else {
   1044  1.46     rmind 		ifp->if_ipackets++;
   1045  1.46     rmind 		ifp->if_ibytes += pktlen;
   1046   1.1  augustss 	}
   1047   1.1  augustss 	splx(s);
   1048  1.21  christos #endif
   1049   1.1  augustss }
   1050