Home | History | Annotate | Line # | Download | only in usb
if_upl.c revision 1.37
      1  1.37     joerg /*	$NetBSD: if_upl.c,v 1.37 2010/04/05 07:21:48 joerg 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.37     joerg __KERNEL_RCSID(0, "$NetBSD: if_upl.c,v 1.37 2010/04/05 07:21:48 joerg 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.37     joerg 	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.37     joerg 	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.37     joerg 	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.37     joerg 	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