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