Home | History | Annotate | Line # | Download | only in usb
if_upl.c revision 1.44.2.1
      1  1.44.2.1     rmind /*	$NetBSD: if_upl.c,v 1.44.2.1 2014/05/18 17:45:47 rmind 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.44.2.1     rmind __KERNEL_RCSID(0, "$NetBSD: if_upl.c,v 1.44.2.1 2014/05/18 17:45:47 rmind 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.1  augustss #include <sys/rnd.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.1  augustss 	    RND_TYPE_NET, 0);
    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.1  augustss 	struct ifqueue *inq;
   1037       1.1  augustss 	int s;
   1038       1.1  augustss 
   1039       1.1  augustss 	/* XXX Assume all traffic is IP */
   1040       1.1  augustss 
   1041       1.1  augustss 	inq = &ipintrq;
   1042       1.1  augustss 
   1043      1.14   thorpej 	s = splnet();
   1044       1.1  augustss 	if (IF_QFULL(inq)) {
   1045       1.1  augustss 		IF_DROP(inq);
   1046       1.1  augustss 		splx(s);
   1047       1.7  augustss #if 0
   1048       1.7  augustss 		if (sc->sc_flags & SC_DEBUG)
   1049       1.7  augustss 			printf("%s: input queue full\n", ifp->if_xname);
   1050       1.7  augustss #endif
   1051       1.1  augustss 		ifp->if_iqdrops++;
   1052       1.1  augustss 		return;
   1053       1.1  augustss 	}
   1054       1.1  augustss 	IF_ENQUEUE(inq, m);
   1055  1.44.2.1     rmind 	schednetisr(NETISR_IP);
   1056       1.1  augustss 	splx(s);
   1057      1.21  christos #endif
   1058       1.1  augustss 	ifp->if_ipackets++;
   1059       1.1  augustss 	ifp->if_ibytes += m->m_len;
   1060       1.1  augustss }
   1061