Home | History | Annotate | Line # | Download | only in usb
if_cdce.c revision 1.45
      1  1.45     skrll /*	$NetBSD: if_cdce.c,v 1.45 2018/01/21 13:57:12 skrll Exp $ */
      2   1.1  augustss 
      3   1.1  augustss /*
      4   1.1  augustss  * Copyright (c) 1997, 1998, 1999, 2000-2003 Bill Paul <wpaul (at) windriver.com>
      5   1.1  augustss  * Copyright (c) 2003 Craig Boston
      6   1.1  augustss  * Copyright (c) 2004 Daniel Hartmeier
      7   1.1  augustss  * All rights reserved.
      8   1.1  augustss  *
      9   1.1  augustss  * Redistribution and use in source and binary forms, with or without
     10   1.1  augustss  * modification, are permitted provided that the following conditions
     11   1.1  augustss  * are met:
     12   1.1  augustss  * 1. Redistributions of source code must retain the above copyright
     13   1.1  augustss  *    notice, this list of conditions and the following disclaimer.
     14   1.1  augustss  * 2. Redistributions in binary form must reproduce the above copyright
     15   1.1  augustss  *    notice, this list of conditions and the following disclaimer in the
     16   1.1  augustss  *    documentation and/or other materials provided with the distribution.
     17   1.1  augustss  * 3. All advertising materials mentioning features or use of this software
     18   1.1  augustss  *    must display the following acknowledgement:
     19   1.1  augustss  *	This product includes software developed by Bill Paul.
     20   1.1  augustss  * 4. Neither the name of the author nor the names of any co-contributors
     21   1.1  augustss  *    may be used to endorse or promote products derived from this software
     22   1.1  augustss  *    without specific prior written permission.
     23   1.1  augustss  *
     24   1.1  augustss  * THIS SOFTWARE IS PROVIDED BY Bill Paul AND CONTRIBUTORS ``AS IS'' AND
     25   1.1  augustss  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
     26   1.1  augustss  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
     27   1.1  augustss  * ARE DISCLAIMED.  IN NO EVENT SHALL Bill Paul, THE VOICES IN HIS HEAD OR
     28   1.1  augustss  * THE CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL,
     29   1.1  augustss  * EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO,
     30   1.1  augustss  * PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS;
     31   1.1  augustss  * OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY,
     32   1.1  augustss  * WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR
     33   1.1  augustss  * OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF
     34   1.1  augustss  * ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
     35   1.1  augustss  */
     36   1.1  augustss 
     37   1.1  augustss /*
     38   1.1  augustss  * USB Communication Device Class (Ethernet Networking Control Model)
     39   1.1  augustss  * http://www.usb.org/developers/devclass_docs/usbcdc11.pdf
     40   1.1  augustss  *
     41   1.1  augustss  */
     42   1.1  augustss 
     43   1.1  augustss #include <sys/cdefs.h>
     44  1.45     skrll __KERNEL_RCSID(0, "$NetBSD: if_cdce.c,v 1.45 2018/01/21 13:57:12 skrll Exp $");
     45  1.36       mrg 
     46  1.38  christos #ifdef _KERNEL_OPT
     47  1.18        ws #include "opt_inet.h"
     48  1.18        ws #endif
     49   1.1  augustss 
     50   1.1  augustss #include <sys/param.h>
     51   1.1  augustss #include <sys/systm.h>
     52   1.1  augustss #include <sys/sockio.h>
     53   1.1  augustss #include <sys/mbuf.h>
     54   1.1  augustss #include <sys/kernel.h>
     55   1.1  augustss #include <sys/socket.h>
     56   1.1  augustss #include <sys/device.h>
     57   1.1  augustss 
     58   1.1  augustss #include <net/if.h>
     59   1.1  augustss #include <net/if_arp.h>
     60   1.1  augustss #include <net/if_dl.h>
     61   1.1  augustss #include <net/if_media.h>
     62   1.1  augustss 
     63   1.1  augustss #include <net/bpf.h>
     64   1.1  augustss 
     65   1.1  augustss #include <net/if_ether.h>
     66   1.1  augustss #ifdef INET
     67   1.1  augustss #include <netinet/in.h>
     68   1.1  augustss #include <netinet/if_inarp.h>
     69   1.1  augustss #endif
     70   1.1  augustss 
     71   1.1  augustss 
     72   1.1  augustss 
     73   1.1  augustss #include <dev/usb/usb.h>
     74   1.1  augustss #include <dev/usb/usbdi.h>
     75   1.1  augustss #include <dev/usb/usbdi_util.h>
     76   1.1  augustss #include <dev/usb/usbdevs.h>
     77   1.1  augustss #include <dev/usb/usbcdc.h>
     78   1.1  augustss 
     79   1.1  augustss #include <dev/usb/if_cdcereg.h>
     80   1.1  augustss 
     81   1.1  augustss Static int	 cdce_tx_list_init(struct cdce_softc *);
     82   1.1  augustss Static int	 cdce_rx_list_init(struct cdce_softc *);
     83   1.1  augustss Static int	 cdce_newbuf(struct cdce_softc *, struct cdce_chain *,
     84   1.1  augustss 		    struct mbuf *);
     85   1.1  augustss Static int	 cdce_encap(struct cdce_softc *, struct mbuf *, int);
     86  1.41     skrll Static void	 cdce_rxeof(struct usbd_xfer *, void *, usbd_status);
     87  1.41     skrll Static void	 cdce_txeof(struct usbd_xfer *, void *, usbd_status);
     88   1.1  augustss Static void	 cdce_start(struct ifnet *);
     89  1.13  christos Static int	 cdce_ioctl(struct ifnet *, u_long, void *);
     90   1.1  augustss Static void	 cdce_init(void *);
     91   1.1  augustss Static void	 cdce_watchdog(struct ifnet *);
     92   1.1  augustss Static void	 cdce_stop(struct cdce_softc *);
     93   1.1  augustss 
     94   1.1  augustss Static const struct cdce_type cdce_devs[] = {
     95  1.33   msaitoh   {{ USB_VENDOR_ACERLABS, USB_PRODUCT_ACERLABS_M5632 }, CDCE_NO_UNION },
     96  1.33   msaitoh   {{ USB_VENDOR_COMPAQ, USB_PRODUCT_COMPAQ_IPAQLINUX }, CDCE_NO_UNION },
     97  1.33   msaitoh   {{ USB_VENDOR_GMATE, USB_PRODUCT_GMATE_YP3X00 }, CDCE_NO_UNION },
     98  1.33   msaitoh   {{ USB_VENDOR_MOTOROLA2, USB_PRODUCT_MOTOROLA2_USBLAN }, CDCE_ZAURUS | CDCE_NO_UNION },
     99  1.33   msaitoh   {{ USB_VENDOR_MOTOROLA2, USB_PRODUCT_MOTOROLA2_USBLAN2 }, CDCE_ZAURUS | CDCE_NO_UNION },
    100   1.1  augustss   {{ USB_VENDOR_PROLIFIC, USB_PRODUCT_PROLIFIC_PL2501 }, CDCE_NO_UNION },
    101   1.1  augustss   {{ USB_VENDOR_SHARP, USB_PRODUCT_SHARP_SL5500 }, CDCE_ZAURUS },
    102   1.1  augustss   {{ USB_VENDOR_SHARP, USB_PRODUCT_SHARP_A300 }, CDCE_ZAURUS | CDCE_NO_UNION },
    103   1.1  augustss   {{ USB_VENDOR_SHARP, USB_PRODUCT_SHARP_SL5600 }, CDCE_ZAURUS | CDCE_NO_UNION },
    104   1.1  augustss   {{ USB_VENDOR_SHARP, USB_PRODUCT_SHARP_C700 }, CDCE_ZAURUS | CDCE_NO_UNION },
    105   1.1  augustss   {{ USB_VENDOR_SHARP, USB_PRODUCT_SHARP_C750 }, CDCE_ZAURUS | CDCE_NO_UNION },
    106   1.1  augustss };
    107  1.33   msaitoh #define cdce_lookup(v, p) \
    108  1.33   msaitoh 	((const struct cdce_type *)usb_lookup(cdce_devs, v, p))
    109   1.1  augustss 
    110  1.23    dyoung int cdce_match(device_t, cfdata_t, void *);
    111  1.23    dyoung void cdce_attach(device_t, device_t, void *);
    112  1.23    dyoung int cdce_detach(device_t, int);
    113  1.23    dyoung int cdce_activate(device_t, enum devact);
    114  1.23    dyoung extern struct cfdriver cdce_cd;
    115  1.23    dyoung CFATTACH_DECL_NEW(cdce, sizeof(struct cdce_softc), cdce_match, cdce_attach,
    116  1.23    dyoung     cdce_detach, cdce_activate);
    117   1.1  augustss 
    118  1.23    dyoung int
    119  1.23    dyoung cdce_match(device_t parent, cfdata_t match, void *aux)
    120   1.1  augustss {
    121  1.41     skrll 	struct usbif_attach_arg *uiaa = aux;
    122   1.1  augustss 
    123  1.41     skrll 	if (cdce_lookup(uiaa->uiaa_vendor, uiaa->uiaa_product) != NULL)
    124  1.41     skrll 		return UMATCH_VENDOR_PRODUCT;
    125   1.1  augustss 
    126  1.41     skrll 	if (uiaa->uiaa_class == UICLASS_CDC && uiaa->uiaa_subclass ==
    127   1.1  augustss 	    UISUBCLASS_ETHERNET_NETWORKING_CONTROL_MODEL)
    128  1.41     skrll 		return UMATCH_IFACECLASS_GENERIC;
    129   1.1  augustss 
    130  1.41     skrll 	return UMATCH_NONE;
    131   1.1  augustss }
    132   1.1  augustss 
    133  1.23    dyoung void
    134  1.23    dyoung cdce_attach(device_t parent, device_t self, void *aux)
    135   1.1  augustss {
    136  1.23    dyoung 	struct cdce_softc *sc = device_private(self);
    137  1.41     skrll 	struct usbif_attach_arg *uiaa = aux;
    138  1.33   msaitoh 	char				*devinfop;
    139   1.1  augustss 	int				 s;
    140   1.1  augustss 	struct ifnet			*ifp;
    141  1.41     skrll 	struct usbd_device	        *dev = uiaa->uiaa_device;
    142   1.1  augustss 	const struct cdce_type		*t;
    143   1.1  augustss 	usb_interface_descriptor_t	*id;
    144   1.1  augustss 	usb_endpoint_descriptor_t	*ed;
    145   1.2  augustss 	const usb_cdc_union_descriptor_t *ud;
    146  1.22      tron 	usb_config_descriptor_t		*cd;
    147   1.1  augustss 	int				 data_ifcno;
    148  1.22      tron 	int				 i, j, numalts;
    149   1.1  augustss 	u_char				 eaddr[ETHER_ADDR_LEN];
    150   1.2  augustss 	const usb_cdc_ethernet_descriptor_t *ue;
    151   1.5  augustss 	char				 eaddr_str[USB_MAX_ENCODED_STRING_LEN];
    152   1.1  augustss 
    153  1.25    plunky 	sc->cdce_dev = self;
    154  1.25    plunky 
    155  1.23    dyoung 	aprint_naive("\n");
    156  1.23    dyoung 	aprint_normal("\n");
    157  1.25    plunky 
    158  1.25    plunky 	devinfop = usbd_devinfo_alloc(dev, 0);
    159  1.16      cube 	aprint_normal_dev(self, "%s\n", devinfop);
    160   1.6  augustss 	usbd_devinfo_free(devinfop);
    161   1.1  augustss 
    162  1.41     skrll 	sc->cdce_udev = uiaa->uiaa_device;
    163  1.41     skrll 	sc->cdce_ctl_iface = uiaa->uiaa_iface;
    164   1.1  augustss 
    165  1.41     skrll 	t = cdce_lookup(uiaa->uiaa_vendor, uiaa->uiaa_product);
    166   1.1  augustss 	if (t)
    167   1.1  augustss 		sc->cdce_flags = t->cdce_flags;
    168   1.1  augustss 
    169   1.1  augustss 	if (sc->cdce_flags & CDCE_NO_UNION)
    170   1.1  augustss 		sc->cdce_data_iface = sc->cdce_ctl_iface;
    171   1.1  augustss 	else {
    172   1.7  christos 		ud = (const usb_cdc_union_descriptor_t *)usb_find_desc(sc->cdce_udev,
    173   1.2  augustss 		    UDESC_CS_INTERFACE, UDESCSUB_CDC_UNION);
    174   1.1  augustss 		if (ud == NULL) {
    175  1.16      cube 			aprint_error_dev(self, "no union descriptor\n");
    176  1.24    dyoung 			return;
    177   1.1  augustss 		}
    178   1.1  augustss 		data_ifcno = ud->bSlaveInterface[0];
    179   1.1  augustss 
    180  1.41     skrll 		for (i = 0; i < uiaa->uiaa_nifaces; i++) {
    181  1.41     skrll 			if (uiaa->uiaa_ifaces[i] != NULL) {
    182   1.1  augustss 				id = usbd_get_interface_descriptor(
    183  1.41     skrll 				    uiaa->uiaa_ifaces[i]);
    184   1.1  augustss 				if (id != NULL && id->bInterfaceNumber ==
    185   1.1  augustss 				    data_ifcno) {
    186  1.41     skrll 					sc->cdce_data_iface = uiaa->uiaa_ifaces[i];
    187  1.41     skrll 					uiaa->uiaa_ifaces[i] = NULL;
    188   1.1  augustss 				}
    189   1.1  augustss 			}
    190   1.1  augustss 		}
    191   1.1  augustss 	}
    192   1.1  augustss 
    193   1.1  augustss 	if (sc->cdce_data_iface == NULL) {
    194  1.16      cube 		aprint_error_dev(self, "no data interface\n");
    195  1.24    dyoung 		return;
    196   1.1  augustss 	}
    197   1.1  augustss 
    198  1.22      tron 	/*
    199  1.22      tron 	 * <quote>
    200  1.22      tron 	 *  The Data Class interface of a networking device shall have a minimum
    201  1.22      tron 	 *  of two interface settings. The first setting (the default interface
    202  1.22      tron 	 *  setting) includes no endpoints and therefore no networking traffic is
    203  1.22      tron 	 *  exchanged whenever the default interface setting is selected. One or
    204  1.22      tron 	 *  more additional interface settings are used for normal operation, and
    205  1.22      tron 	 *  therefore each includes a pair of endpoints (one IN, and one OUT) to
    206  1.22      tron 	 *  exchange network traffic. Select an alternate interface setting to
    207  1.22      tron 	 *  initialize the network aspects of the device and to enable the
    208  1.22      tron 	 *  exchange of network traffic.
    209  1.22      tron 	 * </quote>
    210  1.22      tron 	 *
    211  1.22      tron 	 * Some devices, most notably cable modems, include interface settings
    212  1.22      tron 	 * that have no IN or OUT endpoint, therefore loop through the list of all
    213  1.22      tron 	 * available interface settings looking for one with both IN and OUT
    214  1.22      tron 	 * endpoints.
    215  1.22      tron 	 */
    216   1.1  augustss 	id = usbd_get_interface_descriptor(sc->cdce_data_iface);
    217  1.22      tron 	cd = usbd_get_config_descriptor(sc->cdce_udev);
    218  1.22      tron 	numalts = usbd_get_no_alts(cd, id->bInterfaceNumber);
    219  1.22      tron 
    220  1.22      tron 	for (j = 0; j < numalts; j++) {
    221  1.22      tron 		if (usbd_set_interface(sc->cdce_data_iface, j)) {
    222  1.22      tron 			aprint_error_dev(sc->cdce_dev,
    223  1.22      tron 					"setting alternate interface failed\n");
    224  1.24    dyoung 			return;
    225   1.1  augustss 		}
    226  1.22      tron 		/* Find endpoints. */
    227  1.22      tron 		id = usbd_get_interface_descriptor(sc->cdce_data_iface);
    228  1.22      tron 		sc->cdce_bulkin_no = sc->cdce_bulkout_no = -1;
    229  1.22      tron 		for (i = 0; i < id->bNumEndpoints; i++) {
    230  1.22      tron 			ed = usbd_interface2endpoint_descriptor(sc->cdce_data_iface, i);
    231  1.22      tron 			if (!ed) {
    232  1.22      tron 				aprint_error_dev(self,
    233  1.22      tron 						"could not read endpoint descriptor\n");
    234  1.24    dyoung 				return;
    235  1.22      tron 			}
    236  1.22      tron 			if (UE_GET_DIR(ed->bEndpointAddress) == UE_DIR_IN &&
    237  1.22      tron 					UE_GET_XFERTYPE(ed->bmAttributes) == UE_BULK) {
    238  1.22      tron 				sc->cdce_bulkin_no = ed->bEndpointAddress;
    239  1.22      tron 			} else if (UE_GET_DIR(ed->bEndpointAddress) == UE_DIR_OUT &&
    240  1.22      tron 					UE_GET_XFERTYPE(ed->bmAttributes) == UE_BULK) {
    241  1.22      tron 				sc->cdce_bulkout_no = ed->bEndpointAddress;
    242  1.22      tron 			} else if (UE_GET_DIR(ed->bEndpointAddress) == UE_DIR_IN &&
    243  1.22      tron 					UE_GET_XFERTYPE(ed->bmAttributes) == UE_INTERRUPT) {
    244  1.22      tron 				/* XXX: CDC spec defines an interrupt pipe, but it is not
    245  1.22      tron 				 * needed for simple host-to-host applications. */
    246  1.22      tron 			} else {
    247  1.22      tron 				aprint_error_dev(self, "unexpected endpoint\n");
    248  1.22      tron 			}
    249   1.1  augustss 		}
    250  1.22      tron 		/* If we found something, try and use it... */
    251  1.22      tron 		if ((sc->cdce_bulkin_no != -1) && (sc->cdce_bulkout_no != -1))
    252  1.22      tron 			break;
    253   1.1  augustss 	}
    254   1.1  augustss 
    255   1.1  augustss 	if (sc->cdce_bulkin_no == -1) {
    256  1.16      cube 		aprint_error_dev(self, "could not find data bulk in\n");
    257  1.24    dyoung 		return;
    258   1.1  augustss 	}
    259   1.1  augustss 	if (sc->cdce_bulkout_no == -1 ) {
    260  1.16      cube 		aprint_error_dev(self, "could not find data bulk out\n");
    261  1.24    dyoung 		return;
    262   1.1  augustss 	}
    263   1.1  augustss 
    264   1.7  christos 	ue = (const usb_cdc_ethernet_descriptor_t *)usb_find_desc(dev,
    265  1.30  jakllsch 	    UDESC_CS_INTERFACE, UDESCSUB_CDC_ENF);
    266  1.30  jakllsch 	if (!ue || usbd_get_string(dev, ue->iMacAddress, eaddr_str) ||
    267  1.30  jakllsch 	    ether_aton_r(eaddr, sizeof(eaddr), eaddr_str)) {
    268  1.16      cube 		aprint_normal_dev(self, "faking address\n");
    269   1.2  augustss 		eaddr[0]= 0x2a;
    270  1.30  jakllsch 		memcpy(&eaddr[1], &hardclock_ticks, sizeof(uint32_t));
    271  1.30  jakllsch 		eaddr[5] = (uint8_t)(device_unit(sc->cdce_dev));
    272   1.2  augustss 	}
    273   1.2  augustss 
    274   1.1  augustss 	s = splnet();
    275   1.1  augustss 
    276  1.16      cube 	aprint_normal_dev(self, "address %s\n", ether_sprintf(eaddr));
    277   1.1  augustss 
    278   1.1  augustss 	ifp = GET_IFP(sc);
    279   1.1  augustss 	ifp->if_softc = sc;
    280   1.1  augustss 	ifp->if_flags = IFF_BROADCAST | IFF_SIMPLEX | IFF_MULTICAST;
    281   1.1  augustss 	ifp->if_ioctl = cdce_ioctl;
    282   1.1  augustss 	ifp->if_start = cdce_start;
    283   1.1  augustss 	ifp->if_watchdog = cdce_watchdog;
    284  1.44      maya 	strlcpy(ifp->if_xname, device_xname(sc->cdce_dev), IFNAMSIZ);
    285   1.1  augustss 
    286   1.1  augustss 	IFQ_SET_READY(&ifp->if_snd);
    287   1.1  augustss 
    288   1.1  augustss 	if_attach(ifp);
    289  1.24    dyoung 	ether_ifattach(ifp, eaddr);
    290   1.1  augustss 
    291   1.1  augustss 	sc->cdce_attached = 1;
    292   1.1  augustss 	splx(s);
    293   1.1  augustss 
    294   1.1  augustss 	usbd_add_drv_event(USB_EVENT_DRIVER_ATTACH, sc->cdce_udev,
    295  1.24    dyoung 	    sc->cdce_dev);
    296   1.1  augustss 
    297  1.31  jakllsch 	if (!pmf_device_register(self, NULL, NULL))
    298  1.31  jakllsch 		aprint_error_dev(self, "couldn't establish power handler\n");
    299  1.31  jakllsch 
    300  1.24    dyoung 	return;
    301   1.1  augustss }
    302   1.1  augustss 
    303  1.23    dyoung int
    304  1.23    dyoung cdce_detach(device_t self, int flags)
    305   1.1  augustss {
    306  1.24    dyoung 	struct cdce_softc *sc = device_private(self);
    307   1.1  augustss 	struct ifnet	*ifp = GET_IFP(sc);
    308   1.1  augustss 	int		 s;
    309   1.1  augustss 
    310  1.37    plunky 	pmf_device_deregister(self);
    311  1.31  jakllsch 
    312   1.1  augustss 	s = splusb();
    313   1.1  augustss 
    314   1.1  augustss 	if (!sc->cdce_attached) {
    315   1.1  augustss 		splx(s);
    316  1.41     skrll 		return 0;
    317   1.1  augustss 	}
    318   1.1  augustss 
    319   1.1  augustss 	if (ifp->if_flags & IFF_RUNNING)
    320   1.1  augustss 		cdce_stop(sc);
    321   1.1  augustss 
    322   1.1  augustss 	ether_ifdetach(ifp);
    323   1.1  augustss 
    324   1.1  augustss 	if_detach(ifp);
    325   1.1  augustss 
    326   1.1  augustss 	sc->cdce_attached = 0;
    327   1.1  augustss 	splx(s);
    328   1.1  augustss 
    329  1.41     skrll 	return 0;
    330   1.1  augustss }
    331   1.1  augustss 
    332   1.1  augustss Static void
    333   1.1  augustss cdce_start(struct ifnet *ifp)
    334   1.1  augustss {
    335   1.1  augustss 	struct cdce_softc	*sc = ifp->if_softc;
    336   1.1  augustss 	struct mbuf		*m_head = NULL;
    337   1.1  augustss 
    338   1.1  augustss 	if (sc->cdce_dying || (ifp->if_flags & IFF_OACTIVE))
    339   1.1  augustss 		return;
    340   1.1  augustss 
    341   1.1  augustss 	IFQ_POLL(&ifp->if_snd, m_head);
    342   1.1  augustss 	if (m_head == NULL)
    343   1.1  augustss 		return;
    344   1.1  augustss 
    345   1.1  augustss 	if (cdce_encap(sc, m_head, 0)) {
    346   1.1  augustss 		ifp->if_flags |= IFF_OACTIVE;
    347   1.1  augustss 		return;
    348   1.1  augustss 	}
    349   1.1  augustss 
    350   1.1  augustss 	IFQ_DEQUEUE(&ifp->if_snd, m_head);
    351   1.1  augustss 
    352  1.28     joerg 	bpf_mtap(ifp, m_head);
    353   1.1  augustss 
    354   1.1  augustss 	ifp->if_flags |= IFF_OACTIVE;
    355   1.1  augustss 
    356   1.1  augustss 	ifp->if_timer = 6;
    357   1.1  augustss }
    358   1.1  augustss 
    359   1.1  augustss Static int
    360   1.1  augustss cdce_encap(struct cdce_softc *sc, struct mbuf *m, int idx)
    361   1.1  augustss {
    362   1.1  augustss 	struct cdce_chain	*c;
    363   1.1  augustss 	usbd_status		 err;
    364   1.1  augustss 	int			 extra = 0;
    365   1.1  augustss 
    366   1.1  augustss 	c = &sc->cdce_cdata.cdce_tx_chain[idx];
    367   1.1  augustss 
    368   1.1  augustss 	m_copydata(m, 0, m->m_pkthdr.len, c->cdce_buf);
    369   1.1  augustss 	if (sc->cdce_flags & CDCE_ZAURUS) {
    370   1.1  augustss 		/* Zaurus wants a 32-bit CRC appended to every frame */
    371  1.30  jakllsch 		uint32_t crc;
    372   1.1  augustss 
    373  1.30  jakllsch 		crc = htole32(~ether_crc32_le(c->cdce_buf, m->m_pkthdr.len));
    374  1.30  jakllsch 		memcpy(c->cdce_buf + m->m_pkthdr.len, &crc, sizeof(crc));
    375  1.30  jakllsch 		extra = sizeof(crc);
    376   1.1  augustss 	}
    377   1.1  augustss 	c->cdce_mbuf = m;
    378   1.1  augustss 
    379  1.41     skrll 	usbd_setup_xfer(c->cdce_xfer, c, c->cdce_buf, m->m_pkthdr.len + extra,
    380  1.41     skrll 	    USBD_FORCE_SHORT_XFER, 10000, cdce_txeof);
    381   1.1  augustss 	err = usbd_transfer(c->cdce_xfer);
    382   1.1  augustss 	if (err != USBD_IN_PROGRESS) {
    383   1.1  augustss 		cdce_stop(sc);
    384  1.41     skrll 		return EIO;
    385   1.1  augustss 	}
    386   1.1  augustss 
    387   1.1  augustss 	sc->cdce_cdata.cdce_tx_cnt++;
    388   1.1  augustss 
    389  1.41     skrll 	return 0;
    390   1.1  augustss }
    391   1.1  augustss 
    392   1.1  augustss Static void
    393   1.1  augustss cdce_stop(struct cdce_softc *sc)
    394   1.1  augustss {
    395   1.1  augustss 	usbd_status	 err;
    396   1.1  augustss 	struct ifnet	*ifp = GET_IFP(sc);
    397   1.1  augustss 	int		 i;
    398   1.1  augustss 
    399   1.1  augustss 	ifp->if_timer = 0;
    400   1.1  augustss 
    401   1.1  augustss 	if (sc->cdce_bulkin_pipe != NULL) {
    402   1.1  augustss 		err = usbd_abort_pipe(sc->cdce_bulkin_pipe);
    403   1.1  augustss 		if (err)
    404   1.1  augustss 			printf("%s: abort rx pipe failed: %s\n",
    405  1.24    dyoung 			    device_xname(sc->cdce_dev), usbd_errstr(err));
    406   1.1  augustss 	}
    407   1.1  augustss 
    408   1.1  augustss 	if (sc->cdce_bulkout_pipe != NULL) {
    409   1.1  augustss 		err = usbd_abort_pipe(sc->cdce_bulkout_pipe);
    410   1.1  augustss 		if (err)
    411   1.1  augustss 			printf("%s: abort tx pipe failed: %s\n",
    412  1.24    dyoung 			    device_xname(sc->cdce_dev), usbd_errstr(err));
    413   1.1  augustss 	}
    414   1.1  augustss 
    415   1.1  augustss 	for (i = 0; i < CDCE_RX_LIST_CNT; i++) {
    416   1.1  augustss 		if (sc->cdce_cdata.cdce_rx_chain[i].cdce_mbuf != NULL) {
    417   1.1  augustss 			m_freem(sc->cdce_cdata.cdce_rx_chain[i].cdce_mbuf);
    418   1.1  augustss 			sc->cdce_cdata.cdce_rx_chain[i].cdce_mbuf = NULL;
    419   1.1  augustss 		}
    420   1.1  augustss 		if (sc->cdce_cdata.cdce_rx_chain[i].cdce_xfer != NULL) {
    421  1.41     skrll 			usbd_destroy_xfer
    422  1.33   msaitoh 			    (sc->cdce_cdata.cdce_rx_chain[i].cdce_xfer);
    423   1.1  augustss 			sc->cdce_cdata.cdce_rx_chain[i].cdce_xfer = NULL;
    424   1.1  augustss 		}
    425   1.1  augustss 	}
    426   1.1  augustss 
    427   1.1  augustss 	for (i = 0; i < CDCE_TX_LIST_CNT; i++) {
    428   1.1  augustss 		if (sc->cdce_cdata.cdce_tx_chain[i].cdce_mbuf != NULL) {
    429   1.1  augustss 			m_freem(sc->cdce_cdata.cdce_tx_chain[i].cdce_mbuf);
    430   1.1  augustss 			sc->cdce_cdata.cdce_tx_chain[i].cdce_mbuf = NULL;
    431   1.1  augustss 		}
    432   1.1  augustss 		if (sc->cdce_cdata.cdce_tx_chain[i].cdce_xfer != NULL) {
    433  1.41     skrll 			usbd_destroy_xfer(
    434  1.33   msaitoh 				sc->cdce_cdata.cdce_tx_chain[i].cdce_xfer);
    435   1.1  augustss 			sc->cdce_cdata.cdce_tx_chain[i].cdce_xfer = NULL;
    436   1.1  augustss 		}
    437   1.1  augustss 	}
    438   1.1  augustss 
    439  1.41     skrll 	if (sc->cdce_bulkin_pipe != NULL) {
    440  1.41     skrll 		err = usbd_close_pipe(sc->cdce_bulkin_pipe);
    441  1.41     skrll 		if (err)
    442  1.41     skrll 			printf("%s: close rx pipe failed: %s\n",
    443  1.41     skrll 			    device_xname(sc->cdce_dev), usbd_errstr(err));
    444  1.41     skrll 		sc->cdce_bulkin_pipe = NULL;
    445  1.41     skrll 	}
    446  1.41     skrll 
    447  1.41     skrll 	if (sc->cdce_bulkout_pipe != NULL) {
    448  1.41     skrll 		err = usbd_close_pipe(sc->cdce_bulkout_pipe);
    449  1.41     skrll 		if (err)
    450  1.41     skrll 			printf("%s: close tx pipe failed: %s\n",
    451  1.41     skrll 			    device_xname(sc->cdce_dev), usbd_errstr(err));
    452  1.41     skrll 		sc->cdce_bulkout_pipe = NULL;
    453  1.41     skrll 	}
    454  1.41     skrll 
    455   1.1  augustss 	ifp->if_flags &= ~(IFF_RUNNING | IFF_OACTIVE);
    456   1.1  augustss }
    457   1.1  augustss 
    458   1.1  augustss Static int
    459  1.13  christos cdce_ioctl(struct ifnet *ifp, u_long command, void *data)
    460   1.1  augustss {
    461   1.1  augustss 	struct cdce_softc	*sc = ifp->if_softc;
    462   1.1  augustss 	struct ifaddr		*ifa = (struct ifaddr *)data;
    463   1.1  augustss 	struct ifreq		*ifr = (struct ifreq *)data;
    464   1.1  augustss 	int			 s, error = 0;
    465   1.1  augustss 
    466   1.1  augustss 	if (sc->cdce_dying)
    467  1.41     skrll 		return EIO;
    468   1.1  augustss 
    469   1.1  augustss 	s = splnet();
    470   1.1  augustss 
    471   1.1  augustss 	switch(command) {
    472  1.19    dyoung 	case SIOCINITIFADDR:
    473   1.1  augustss 		ifp->if_flags |= IFF_UP;
    474   1.1  augustss 		cdce_init(sc);
    475   1.1  augustss 		switch (ifa->ifa_addr->sa_family) {
    476   1.1  augustss #ifdef INET
    477   1.1  augustss 		case AF_INET:
    478   1.1  augustss 			arp_ifinit(ifp, ifa);
    479   1.1  augustss 			break;
    480   1.1  augustss #endif /* INET */
    481   1.1  augustss 		}
    482   1.1  augustss 		break;
    483   1.1  augustss 
    484   1.1  augustss 	case SIOCSIFMTU:
    485  1.15    dyoung 		if (ifr->ifr_mtu < ETHERMIN || ifr->ifr_mtu > ETHERMTU)
    486   1.1  augustss 			error = EINVAL;
    487  1.15    dyoung 		else if ((error = ifioctl_common(ifp, command, data)) == ENETRESET)
    488  1.15    dyoung 			error = 0;
    489   1.1  augustss 		break;
    490   1.1  augustss 
    491   1.1  augustss 	case SIOCSIFFLAGS:
    492  1.19    dyoung 		if ((error = ifioctl_common(ifp, command, data)) != 0)
    493  1.19    dyoung 			break;
    494  1.19    dyoung 		/* XXX re-use ether_ioctl() */
    495  1.19    dyoung 		switch (ifp->if_flags & (IFF_UP|IFF_RUNNING)) {
    496  1.19    dyoung 		case IFF_UP:
    497  1.19    dyoung 			cdce_init(sc);
    498  1.19    dyoung 			break;
    499  1.19    dyoung 		case IFF_RUNNING:
    500  1.19    dyoung 			cdce_stop(sc);
    501  1.19    dyoung 			break;
    502  1.19    dyoung 		default:
    503  1.19    dyoung 			break;
    504   1.1  augustss 		}
    505   1.1  augustss 		break;
    506   1.1  augustss 
    507   1.1  augustss 	default:
    508  1.19    dyoung 		error = ether_ioctl(ifp, command, data);
    509   1.1  augustss 		break;
    510   1.1  augustss 	}
    511   1.1  augustss 
    512   1.1  augustss 	splx(s);
    513   1.1  augustss 
    514  1.30  jakllsch 	if (error == ENETRESET)
    515  1.30  jakllsch 		error = 0;
    516  1.30  jakllsch 
    517  1.41     skrll 	return error;
    518   1.1  augustss }
    519   1.1  augustss 
    520   1.1  augustss Static void
    521   1.1  augustss cdce_watchdog(struct ifnet *ifp)
    522   1.1  augustss {
    523   1.1  augustss 	struct cdce_softc	*sc = ifp->if_softc;
    524   1.1  augustss 
    525   1.1  augustss 	if (sc->cdce_dying)
    526   1.1  augustss 		return;
    527   1.1  augustss 
    528   1.1  augustss 	ifp->if_oerrors++;
    529  1.24    dyoung 	printf("%s: watchdog timeout\n", device_xname(sc->cdce_dev));
    530   1.1  augustss }
    531   1.1  augustss 
    532   1.1  augustss Static void
    533   1.1  augustss cdce_init(void *xsc)
    534   1.1  augustss {
    535   1.1  augustss 	struct cdce_softc	*sc = xsc;
    536   1.1  augustss 	struct ifnet		*ifp = GET_IFP(sc);
    537   1.1  augustss 	struct cdce_chain	*c;
    538   1.1  augustss 	usbd_status		 err;
    539   1.1  augustss 	int			 s, i;
    540   1.1  augustss 
    541   1.1  augustss 	if (ifp->if_flags & IFF_RUNNING)
    542   1.1  augustss 		return;
    543   1.1  augustss 
    544   1.1  augustss 	s = splnet();
    545   1.1  augustss 
    546   1.1  augustss 	/* Maybe set multicast / broadcast here??? */
    547   1.1  augustss 
    548   1.1  augustss 	err = usbd_open_pipe(sc->cdce_data_iface, sc->cdce_bulkin_no,
    549   1.1  augustss 	    USBD_EXCLUSIVE_USE, &sc->cdce_bulkin_pipe);
    550   1.1  augustss 	if (err) {
    551  1.24    dyoung 		printf("%s: open rx pipe failed: %s\n", device_xname(sc->cdce_dev),
    552   1.1  augustss 		    usbd_errstr(err));
    553   1.1  augustss 		splx(s);
    554   1.1  augustss 		return;
    555   1.1  augustss 	}
    556   1.1  augustss 
    557   1.1  augustss 	err = usbd_open_pipe(sc->cdce_data_iface, sc->cdce_bulkout_no,
    558   1.1  augustss 	    USBD_EXCLUSIVE_USE, &sc->cdce_bulkout_pipe);
    559   1.1  augustss 	if (err) {
    560  1.24    dyoung 		printf("%s: open tx pipe failed: %s\n",
    561  1.24    dyoung 		    device_xname(sc->cdce_dev), usbd_errstr(err));
    562   1.1  augustss 		splx(s);
    563   1.1  augustss 		return;
    564   1.1  augustss 	}
    565   1.1  augustss 
    566  1.41     skrll 	if (cdce_tx_list_init(sc)) {
    567  1.41     skrll 		printf("%s: tx list init failed\n", device_xname(sc->cdce_dev));
    568  1.41     skrll 		splx(s);
    569  1.41     skrll 		return;
    570  1.41     skrll 	}
    571  1.41     skrll 
    572  1.41     skrll 	if (cdce_rx_list_init(sc)) {
    573  1.41     skrll 		printf("%s: rx list init failed\n", device_xname(sc->cdce_dev));
    574  1.41     skrll 		splx(s);
    575  1.41     skrll 		return;
    576  1.41     skrll 	}
    577  1.41     skrll 
    578   1.1  augustss 	for (i = 0; i < CDCE_RX_LIST_CNT; i++) {
    579   1.1  augustss 		c = &sc->cdce_cdata.cdce_rx_chain[i];
    580  1.41     skrll 
    581  1.41     skrll 		usbd_setup_xfer(c->cdce_xfer, c, c->cdce_buf, CDCE_BUFSZ,
    582  1.41     skrll 		    USBD_SHORT_XFER_OK, USBD_NO_TIMEOUT, cdce_rxeof);
    583   1.1  augustss 		usbd_transfer(c->cdce_xfer);
    584   1.1  augustss 	}
    585   1.1  augustss 
    586   1.1  augustss 	ifp->if_flags |= IFF_RUNNING;
    587   1.1  augustss 	ifp->if_flags &= ~IFF_OACTIVE;
    588   1.1  augustss 
    589   1.1  augustss 	splx(s);
    590   1.1  augustss }
    591   1.1  augustss 
    592   1.1  augustss Static int
    593   1.1  augustss cdce_newbuf(struct cdce_softc *sc, struct cdce_chain *c, struct mbuf *m)
    594   1.1  augustss {
    595   1.1  augustss 	struct mbuf	*m_new = NULL;
    596   1.1  augustss 
    597   1.1  augustss 	if (m == NULL) {
    598   1.1  augustss 		MGETHDR(m_new, M_DONTWAIT, MT_DATA);
    599   1.1  augustss 		if (m_new == NULL) {
    600   1.1  augustss 			printf("%s: no memory for rx list "
    601  1.24    dyoung 			    "-- packet dropped!\n", device_xname(sc->cdce_dev));
    602  1.41     skrll 			return ENOBUFS;
    603   1.1  augustss 		}
    604   1.1  augustss 		MCLGET(m_new, M_DONTWAIT);
    605   1.1  augustss 		if (!(m_new->m_flags & M_EXT)) {
    606   1.1  augustss 			printf("%s: no memory for rx list "
    607  1.24    dyoung 			    "-- packet dropped!\n", device_xname(sc->cdce_dev));
    608   1.1  augustss 			m_freem(m_new);
    609  1.41     skrll 			return ENOBUFS;
    610   1.1  augustss 		}
    611   1.1  augustss 		m_new->m_len = m_new->m_pkthdr.len = MCLBYTES;
    612   1.1  augustss 	} else {
    613   1.1  augustss 		m_new = m;
    614   1.1  augustss 		m_new->m_len = m_new->m_pkthdr.len = MCLBYTES;
    615   1.1  augustss 		m_new->m_data = m_new->m_ext.ext_buf;
    616   1.1  augustss 	}
    617   1.1  augustss 	c->cdce_mbuf = m_new;
    618  1.41     skrll 	return 0;
    619   1.1  augustss }
    620   1.1  augustss 
    621   1.1  augustss Static int
    622   1.1  augustss cdce_rx_list_init(struct cdce_softc *sc)
    623   1.1  augustss {
    624   1.1  augustss 	struct cdce_cdata	*cd;
    625   1.1  augustss 	struct cdce_chain	*c;
    626   1.1  augustss 	int			 i;
    627   1.1  augustss 
    628   1.1  augustss 	cd = &sc->cdce_cdata;
    629   1.1  augustss 	for (i = 0; i < CDCE_RX_LIST_CNT; i++) {
    630   1.1  augustss 		c = &cd->cdce_rx_chain[i];
    631   1.1  augustss 		c->cdce_sc = sc;
    632   1.1  augustss 		c->cdce_idx = i;
    633   1.1  augustss 		if (cdce_newbuf(sc, c, NULL) == ENOBUFS)
    634  1.41     skrll 			return ENOBUFS;
    635   1.1  augustss 		if (c->cdce_xfer == NULL) {
    636  1.41     skrll 			int err = usbd_create_xfer(sc->cdce_bulkin_pipe,
    637  1.45     skrll 			    CDCE_BUFSZ, 0, 0, &c->cdce_xfer);
    638  1.41     skrll 			if (err)
    639  1.41     skrll 				return err;
    640  1.41     skrll 			c->cdce_buf = usbd_get_buffer(c->cdce_xfer);
    641   1.1  augustss 		}
    642   1.1  augustss 	}
    643   1.1  augustss 
    644  1.41     skrll 	return 0;
    645   1.1  augustss }
    646   1.1  augustss 
    647   1.1  augustss Static int
    648   1.1  augustss cdce_tx_list_init(struct cdce_softc *sc)
    649   1.1  augustss {
    650   1.1  augustss 	struct cdce_cdata	*cd;
    651   1.1  augustss 	struct cdce_chain	*c;
    652   1.1  augustss 	int			 i;
    653   1.1  augustss 
    654   1.1  augustss 	cd = &sc->cdce_cdata;
    655   1.1  augustss 	for (i = 0; i < CDCE_TX_LIST_CNT; i++) {
    656   1.1  augustss 		c = &cd->cdce_tx_chain[i];
    657   1.1  augustss 		c->cdce_sc = sc;
    658   1.1  augustss 		c->cdce_idx = i;
    659   1.1  augustss 		c->cdce_mbuf = NULL;
    660   1.1  augustss 		if (c->cdce_xfer == NULL) {
    661  1.41     skrll 			int err = usbd_create_xfer(sc->cdce_bulkout_pipe,
    662  1.41     skrll 			    CDCE_BUFSZ, USBD_FORCE_SHORT_XFER, 0,
    663  1.41     skrll 			    &c->cdce_xfer);
    664  1.41     skrll 			if (err)
    665  1.41     skrll 				return err;
    666  1.41     skrll 			c->cdce_buf = usbd_get_buffer(c->cdce_xfer);
    667   1.1  augustss 		}
    668   1.1  augustss 	}
    669   1.1  augustss 
    670  1.41     skrll 	return 0;
    671   1.1  augustss }
    672   1.1  augustss 
    673   1.1  augustss Static void
    674  1.41     skrll cdce_rxeof(struct usbd_xfer *xfer, void *priv, usbd_status status)
    675   1.1  augustss {
    676   1.1  augustss 	struct cdce_chain	*c = priv;
    677   1.1  augustss 	struct cdce_softc	*sc = c->cdce_sc;
    678   1.1  augustss 	struct ifnet		*ifp = GET_IFP(sc);
    679   1.1  augustss 	struct mbuf		*m;
    680   1.1  augustss 	int			 total_len = 0;
    681   1.1  augustss 	int			 s;
    682   1.1  augustss 
    683   1.1  augustss 	if (sc->cdce_dying || !(ifp->if_flags & IFF_RUNNING))
    684   1.1  augustss 		return;
    685   1.1  augustss 
    686   1.1  augustss 	if (status != USBD_NORMAL_COMPLETION) {
    687   1.1  augustss 		if (status == USBD_NOT_STARTED || status == USBD_CANCELLED)
    688   1.1  augustss 			return;
    689   1.1  augustss 		if (sc->cdce_rxeof_errors == 0)
    690   1.1  augustss 			printf("%s: usb error on rx: %s\n",
    691  1.24    dyoung 			    device_xname(sc->cdce_dev), usbd_errstr(status));
    692   1.1  augustss 		if (status == USBD_STALLED)
    693   1.8  augustss 			usbd_clear_endpoint_stall_async(sc->cdce_bulkin_pipe);
    694   1.1  augustss 		DELAY(sc->cdce_rxeof_errors * 10000);
    695   1.1  augustss 		sc->cdce_rxeof_errors++;
    696   1.1  augustss 		goto done;
    697   1.1  augustss 	}
    698   1.1  augustss 
    699   1.1  augustss 	sc->cdce_rxeof_errors = 0;
    700   1.1  augustss 
    701   1.1  augustss 	usbd_get_xfer_status(xfer, NULL, NULL, &total_len, NULL);
    702   1.1  augustss 	if (sc->cdce_flags & CDCE_ZAURUS)
    703   1.1  augustss 		total_len -= 4;	/* Strip off CRC added by Zaurus */
    704   1.1  augustss 	if (total_len <= 1)
    705   1.1  augustss 		goto done;
    706   1.1  augustss 
    707   1.1  augustss 	m = c->cdce_mbuf;
    708   1.1  augustss 	memcpy(mtod(m, char *), c->cdce_buf, total_len);
    709   1.1  augustss 
    710   1.1  augustss 	if (total_len < sizeof(struct ether_header)) {
    711   1.1  augustss 		ifp->if_ierrors++;
    712   1.1  augustss 		goto done;
    713   1.1  augustss 	}
    714   1.1  augustss 
    715   1.1  augustss 	m->m_pkthdr.len = m->m_len = total_len;
    716  1.42     ozaki 	m_set_rcvif(m, ifp);
    717   1.1  augustss 
    718   1.1  augustss 	s = splnet();
    719   1.1  augustss 
    720   1.1  augustss 	if (cdce_newbuf(sc, c, NULL) == ENOBUFS) {
    721   1.1  augustss 		ifp->if_ierrors++;
    722   1.1  augustss 		goto done1;
    723   1.1  augustss 	}
    724   1.1  augustss 
    725  1.40     ozaki 	if_percpuq_enqueue((ifp)->if_percpuq, (m));
    726   1.1  augustss 
    727   1.1  augustss done1:
    728   1.1  augustss 	splx(s);
    729   1.1  augustss 
    730   1.1  augustss done:
    731   1.1  augustss 	/* Setup new transfer. */
    732  1.41     skrll 	usbd_setup_xfer(c->cdce_xfer, c, c->cdce_buf, CDCE_BUFSZ,
    733  1.41     skrll 	    USBD_SHORT_XFER_OK, USBD_NO_TIMEOUT, cdce_rxeof);
    734   1.1  augustss 	usbd_transfer(c->cdce_xfer);
    735   1.1  augustss }
    736   1.1  augustss 
    737   1.1  augustss Static void
    738  1.41     skrll cdce_txeof(struct usbd_xfer *xfer, void *priv,
    739  1.11  christos     usbd_status status)
    740   1.1  augustss {
    741   1.1  augustss 	struct cdce_chain	*c = priv;
    742   1.1  augustss 	struct cdce_softc	*sc = c->cdce_sc;
    743   1.1  augustss 	struct ifnet		*ifp = GET_IFP(sc);
    744   1.1  augustss 	usbd_status		 err;
    745   1.1  augustss 	int			 s;
    746   1.1  augustss 
    747   1.1  augustss 	if (sc->cdce_dying)
    748   1.1  augustss 		return;
    749   1.1  augustss 
    750   1.1  augustss 	s = splnet();
    751   1.1  augustss 
    752   1.1  augustss 	ifp->if_timer = 0;
    753   1.1  augustss 	ifp->if_flags &= ~IFF_OACTIVE;
    754   1.1  augustss 
    755   1.1  augustss 	if (status != USBD_NORMAL_COMPLETION) {
    756   1.1  augustss 		if (status == USBD_NOT_STARTED || status == USBD_CANCELLED) {
    757   1.1  augustss 			splx(s);
    758   1.1  augustss 			return;
    759   1.1  augustss 		}
    760   1.1  augustss 		ifp->if_oerrors++;
    761  1.24    dyoung 		printf("%s: usb error on tx: %s\n", device_xname(sc->cdce_dev),
    762  1.24    dyoung 		    usbd_errstr(status));
    763   1.1  augustss 		if (status == USBD_STALLED)
    764   1.8  augustss 			usbd_clear_endpoint_stall_async(sc->cdce_bulkout_pipe);
    765   1.1  augustss 		splx(s);
    766   1.1  augustss 		return;
    767   1.1  augustss 	}
    768   1.1  augustss 
    769   1.1  augustss 	usbd_get_xfer_status(c->cdce_xfer, NULL, NULL, NULL, &err);
    770   1.1  augustss 
    771   1.1  augustss 	if (c->cdce_mbuf != NULL) {
    772   1.1  augustss 		m_freem(c->cdce_mbuf);
    773   1.1  augustss 		c->cdce_mbuf = NULL;
    774   1.1  augustss 	}
    775   1.1  augustss 
    776   1.1  augustss 	if (err)
    777   1.1  augustss 		ifp->if_oerrors++;
    778   1.1  augustss 	else
    779   1.1  augustss 		ifp->if_opackets++;
    780   1.1  augustss 
    781   1.1  augustss 	if (IFQ_IS_EMPTY(&ifp->if_snd) == 0)
    782   1.1  augustss 		cdce_start(ifp);
    783   1.1  augustss 
    784   1.1  augustss 	splx(s);
    785   1.1  augustss }
    786   1.1  augustss 
    787   1.4  augustss int
    788  1.23    dyoung cdce_activate(device_t self, enum devact act)
    789   1.1  augustss {
    790  1.16      cube 	struct cdce_softc *sc = device_private(self);
    791   1.1  augustss 
    792   1.1  augustss 	switch (act) {
    793   1.1  augustss 	case DVACT_DEACTIVATE:
    794   1.1  augustss 		if_deactivate(GET_IFP(sc));
    795   1.1  augustss 		sc->cdce_dying = 1;
    796  1.26    dyoung 		return 0;
    797  1.26    dyoung 	default:
    798  1.26    dyoung 		return EOPNOTSUPP;
    799   1.1  augustss 	}
    800   1.1  augustss }
    801