Home | History | Annotate | Line # | Download | only in usb
if_urndis.c revision 1.4.2.3
      1  1.4.2.1       tls /*	$NetBSD: if_urndis.c,v 1.4.2.3 2017/12/03 11:37:34 jdolecek Exp $ */
      2      1.1  jakllsch /*	$OpenBSD: if_urndis.c,v 1.31 2011/07/03 15:47:17 matthew Exp $ */
      3      1.1  jakllsch 
      4      1.1  jakllsch /*
      5      1.1  jakllsch  * Copyright (c) 2010 Jonathan Armani <armani (at) openbsd.org>
      6      1.1  jakllsch  * Copyright (c) 2010 Fabien Romano <fabien (at) openbsd.org>
      7      1.1  jakllsch  * Copyright (c) 2010 Michael Knudsen <mk (at) openbsd.org>
      8      1.1  jakllsch  * All rights reserved.
      9      1.1  jakllsch  *
     10      1.1  jakllsch  * Permission to use, copy, modify, and distribute this software for any
     11      1.1  jakllsch  * purpose with or without fee is hereby granted, provided that the above
     12      1.1  jakllsch  * copyright notice and this permission notice appear in all copies.
     13      1.1  jakllsch  *
     14      1.1  jakllsch  * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
     15      1.1  jakllsch  * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
     16      1.1  jakllsch  * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
     17      1.1  jakllsch  * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
     18      1.1  jakllsch  * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
     19      1.1  jakllsch  * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
     20      1.1  jakllsch  * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
     21      1.1  jakllsch  */
     22      1.1  jakllsch 
     23      1.1  jakllsch #include <sys/cdefs.h>
     24  1.4.2.1       tls __KERNEL_RCSID(0, "$NetBSD: if_urndis.c,v 1.4.2.3 2017/12/03 11:37:34 jdolecek Exp $");
     25      1.1  jakllsch 
     26  1.4.2.3  jdolecek #ifdef _KERNEL_OPT
     27  1.4.2.3  jdolecek #include "opt_usb.h"
     28  1.4.2.3  jdolecek #endif
     29  1.4.2.3  jdolecek 
     30      1.1  jakllsch #include <sys/param.h>
     31      1.1  jakllsch #include <sys/systm.h>
     32      1.1  jakllsch #include <sys/sockio.h>
     33      1.1  jakllsch #include <sys/rwlock.h>
     34      1.1  jakllsch #include <sys/mbuf.h>
     35      1.1  jakllsch #include <sys/kmem.h>
     36      1.1  jakllsch #include <sys/kernel.h>
     37      1.1  jakllsch #include <sys/proc.h>
     38      1.1  jakllsch #include <sys/socket.h>
     39      1.1  jakllsch #include <sys/device.h>
     40      1.1  jakllsch 
     41      1.1  jakllsch #include <net/if.h>
     42      1.1  jakllsch #include <net/if_dl.h>
     43      1.1  jakllsch #include <net/if_media.h>
     44      1.1  jakllsch #include <net/if_ether.h>
     45      1.1  jakllsch 
     46      1.1  jakllsch #include <net/bpf.h>
     47      1.1  jakllsch 
     48      1.1  jakllsch #include <sys/bus.h>
     49      1.1  jakllsch #include <dev/usb/usb.h>
     50      1.1  jakllsch #include <dev/usb/usbdi.h>
     51      1.1  jakllsch #include <dev/usb/usbdi_util.h>
     52      1.1  jakllsch #include <dev/usb/usbdivar.h>
     53      1.1  jakllsch #include <dev/usb/usbdevs.h>
     54      1.1  jakllsch #include <dev/usb/usbcdc.h>
     55      1.1  jakllsch 
     56      1.1  jakllsch #include <dev/usb/if_urndisreg.h>
     57      1.1  jakllsch 
     58      1.1  jakllsch #ifdef URNDIS_DEBUG
     59      1.1  jakllsch #define DPRINTF(x)      do { printf x; } while (0)
     60      1.1  jakllsch #else
     61      1.1  jakllsch #define DPRINTF(x)
     62      1.1  jakllsch #endif
     63      1.1  jakllsch 
     64      1.1  jakllsch #define DEVNAME(sc)	(device_xname(sc->sc_dev))
     65      1.1  jakllsch 
     66      1.1  jakllsch #define ETHER_ALIGN 2
     67      1.1  jakllsch #define URNDIS_RESPONSE_LEN 0x400
     68      1.1  jakllsch 
     69      1.1  jakllsch 
     70      1.1  jakllsch static int urndis_newbuf(struct urndis_softc *, struct urndis_chain *);
     71      1.1  jakllsch 
     72      1.1  jakllsch static int urndis_ioctl(struct ifnet *, unsigned long, void *);
     73      1.1  jakllsch #if 0
     74      1.1  jakllsch static void urndis_watchdog(struct ifnet *);
     75      1.1  jakllsch #endif
     76      1.1  jakllsch 
     77      1.1  jakllsch static void urndis_start(struct ifnet *);
     78  1.4.2.3  jdolecek static void urndis_rxeof(struct usbd_xfer *, void *, usbd_status);
     79  1.4.2.3  jdolecek static void urndis_txeof(struct usbd_xfer *, void *, usbd_status);
     80      1.1  jakllsch static int urndis_rx_list_init(struct urndis_softc *);
     81      1.1  jakllsch static int urndis_tx_list_init(struct urndis_softc *);
     82      1.1  jakllsch 
     83  1.4.2.2       tls static int urndis_init(struct ifnet *);
     84      1.1  jakllsch static void urndis_stop(struct ifnet *);
     85      1.1  jakllsch 
     86      1.1  jakllsch static usbd_status urndis_ctrl_msg(struct urndis_softc *, uint8_t, uint8_t,
     87      1.1  jakllsch     uint16_t, uint16_t, void *, size_t);
     88      1.1  jakllsch static usbd_status urndis_ctrl_send(struct urndis_softc *, void *, size_t);
     89      1.1  jakllsch static struct urndis_comp_hdr *urndis_ctrl_recv(struct urndis_softc *);
     90      1.1  jakllsch 
     91      1.1  jakllsch static uint32_t urndis_ctrl_handle(struct urndis_softc *,
     92      1.1  jakllsch     struct urndis_comp_hdr *, void **, size_t *);
     93      1.1  jakllsch static uint32_t urndis_ctrl_handle_init(struct urndis_softc *,
     94      1.1  jakllsch     const struct urndis_comp_hdr *);
     95      1.1  jakllsch static uint32_t urndis_ctrl_handle_query(struct urndis_softc *,
     96      1.1  jakllsch     const struct urndis_comp_hdr *, void **, size_t *);
     97      1.1  jakllsch static uint32_t urndis_ctrl_handle_reset(struct urndis_softc *,
     98      1.1  jakllsch     const struct urndis_comp_hdr *);
     99      1.1  jakllsch 
    100      1.1  jakllsch static uint32_t urndis_ctrl_init(struct urndis_softc *);
    101      1.1  jakllsch #if 0
    102      1.1  jakllsch static uint32_t urndis_ctrl_halt(struct urndis_softc *);
    103      1.1  jakllsch #endif
    104      1.1  jakllsch static uint32_t urndis_ctrl_query(struct urndis_softc *, uint32_t, void *,
    105      1.1  jakllsch     size_t, void **, size_t *);
    106  1.4.2.3  jdolecek static uint32_t urndis_ctrl_set(struct urndis_softc *, uint32_t, void *,
    107  1.4.2.3  jdolecek     size_t);
    108      1.1  jakllsch #if 0
    109      1.1  jakllsch static uint32_t urndis_ctrl_set_param(struct urndis_softc *, const char *,
    110      1.1  jakllsch     uint32_t, void *, size_t);
    111      1.1  jakllsch static uint32_t urndis_ctrl_reset(struct urndis_softc *);
    112      1.1  jakllsch static uint32_t urndis_ctrl_keepalive(struct urndis_softc *);
    113      1.1  jakllsch #endif
    114      1.1  jakllsch 
    115      1.1  jakllsch static int urndis_encap(struct urndis_softc *, struct mbuf *, int);
    116  1.4.2.3  jdolecek static void urndis_decap(struct urndis_softc *, struct urndis_chain *,
    117  1.4.2.3  jdolecek     uint32_t);
    118      1.1  jakllsch 
    119      1.1  jakllsch static int urndis_match(device_t, cfdata_t, void *);
    120      1.1  jakllsch static void urndis_attach(device_t, device_t, void *);
    121      1.1  jakllsch static int urndis_detach(device_t, int);
    122      1.1  jakllsch static int urndis_activate(device_t, enum devact);
    123      1.1  jakllsch 
    124      1.1  jakllsch CFATTACH_DECL_NEW(urndis, sizeof(struct urndis_softc),
    125      1.1  jakllsch     urndis_match, urndis_attach, urndis_detach, urndis_activate);
    126      1.1  jakllsch 
    127      1.1  jakllsch /*
    128      1.1  jakllsch  * Supported devices that we can't match by class IDs.
    129      1.1  jakllsch  */
    130      1.1  jakllsch static const struct usb_devno urndis_devs[] = {
    131      1.1  jakllsch 	{ USB_VENDOR_HTC,	USB_PRODUCT_HTC_ANDROID },
    132      1.1  jakllsch 	{ USB_VENDOR_SAMSUNG,	USB_PRODUCT_SAMSUNG_ANDROID2 },
    133      1.1  jakllsch };
    134      1.1  jakllsch 
    135      1.1  jakllsch static usbd_status
    136      1.1  jakllsch urndis_ctrl_msg(struct urndis_softc *sc, uint8_t rt, uint8_t r,
    137      1.1  jakllsch     uint16_t index, uint16_t value, void *buf, size_t buflen)
    138      1.1  jakllsch {
    139      1.1  jakllsch 	usb_device_request_t req;
    140      1.1  jakllsch 
    141      1.1  jakllsch 	req.bmRequestType = rt;
    142      1.1  jakllsch 	req.bRequest = r;
    143      1.1  jakllsch 	USETW(req.wValue, value);
    144      1.1  jakllsch 	USETW(req.wIndex, index);
    145      1.1  jakllsch 	USETW(req.wLength, buflen);
    146      1.1  jakllsch 
    147      1.1  jakllsch 	return usbd_do_request(sc->sc_udev, &req, buf);
    148      1.1  jakllsch }
    149      1.1  jakllsch 
    150      1.1  jakllsch static usbd_status
    151      1.1  jakllsch urndis_ctrl_send(struct urndis_softc *sc, void *buf, size_t len)
    152      1.1  jakllsch {
    153      1.1  jakllsch 	usbd_status err;
    154      1.1  jakllsch 
    155      1.1  jakllsch 	if (sc->sc_dying)
    156      1.1  jakllsch 		return(0);
    157      1.1  jakllsch 
    158      1.1  jakllsch 	err = urndis_ctrl_msg(sc, UT_WRITE_CLASS_INTERFACE, UR_GET_STATUS,
    159      1.1  jakllsch 	    sc->sc_ifaceno_ctl, 0, buf, len);
    160      1.1  jakllsch 
    161      1.1  jakllsch 	if (err != USBD_NORMAL_COMPLETION)
    162      1.1  jakllsch 		printf("%s: %s\n", DEVNAME(sc), usbd_errstr(err));
    163      1.1  jakllsch 
    164      1.1  jakllsch 	return err;
    165      1.1  jakllsch }
    166      1.1  jakllsch 
    167      1.1  jakllsch static struct urndis_comp_hdr *
    168      1.1  jakllsch urndis_ctrl_recv(struct urndis_softc *sc)
    169      1.1  jakllsch {
    170      1.1  jakllsch 	struct urndis_comp_hdr	*hdr;
    171      1.1  jakllsch 	char			*buf;
    172      1.1  jakllsch 	usbd_status		 err;
    173      1.1  jakllsch 
    174      1.1  jakllsch 	buf = kmem_alloc(URNDIS_RESPONSE_LEN, KM_SLEEP);
    175      1.1  jakllsch 	err = urndis_ctrl_msg(sc, UT_READ_CLASS_INTERFACE, UR_CLEAR_FEATURE,
    176      1.1  jakllsch 	    sc->sc_ifaceno_ctl, 0, buf, URNDIS_RESPONSE_LEN);
    177      1.1  jakllsch 
    178      1.1  jakllsch 	if (err != USBD_NORMAL_COMPLETION && err != USBD_SHORT_XFER) {
    179      1.1  jakllsch 		printf("%s: %s\n", DEVNAME(sc), usbd_errstr(err));
    180      1.1  jakllsch 		kmem_free(buf, URNDIS_RESPONSE_LEN);
    181      1.1  jakllsch 		return NULL;
    182      1.1  jakllsch 	}
    183      1.1  jakllsch 
    184      1.1  jakllsch 	hdr = (struct urndis_comp_hdr *)buf;
    185      1.1  jakllsch 	DPRINTF(("%s: urndis_ctrl_recv: type 0x%x len %u\n",
    186      1.1  jakllsch 	    DEVNAME(sc),
    187      1.1  jakllsch 	    le32toh(hdr->rm_type),
    188      1.1  jakllsch 	    le32toh(hdr->rm_len)));
    189      1.1  jakllsch 
    190      1.1  jakllsch 	if (le32toh(hdr->rm_len) > URNDIS_RESPONSE_LEN) {
    191      1.1  jakllsch 		printf("%s: ctrl message error: wrong size %u > %u\n",
    192      1.1  jakllsch 		    DEVNAME(sc),
    193      1.1  jakllsch 		    le32toh(hdr->rm_len),
    194      1.1  jakllsch 		    URNDIS_RESPONSE_LEN);
    195      1.1  jakllsch 		kmem_free(buf, URNDIS_RESPONSE_LEN);
    196      1.1  jakllsch 		return NULL;
    197      1.1  jakllsch 	}
    198      1.1  jakllsch 
    199      1.1  jakllsch 	return hdr;
    200      1.1  jakllsch }
    201      1.1  jakllsch 
    202      1.1  jakllsch static uint32_t
    203      1.1  jakllsch urndis_ctrl_handle(struct urndis_softc *sc, struct urndis_comp_hdr *hdr,
    204      1.1  jakllsch     void **buf, size_t *bufsz)
    205      1.1  jakllsch {
    206      1.1  jakllsch 	uint32_t rval;
    207      1.1  jakllsch 
    208      1.1  jakllsch 	DPRINTF(("%s: urndis_ctrl_handle\n", DEVNAME(sc)));
    209      1.1  jakllsch 
    210      1.1  jakllsch 	if (buf && bufsz) {
    211      1.1  jakllsch 		*buf = NULL;
    212      1.1  jakllsch 		*bufsz = 0;
    213      1.1  jakllsch 	}
    214      1.1  jakllsch 
    215      1.1  jakllsch 	switch (le32toh(hdr->rm_type)) {
    216      1.1  jakllsch 		case REMOTE_NDIS_INITIALIZE_CMPLT:
    217      1.1  jakllsch 			rval = urndis_ctrl_handle_init(sc, hdr);
    218      1.1  jakllsch 			break;
    219      1.1  jakllsch 
    220      1.1  jakllsch 		case REMOTE_NDIS_QUERY_CMPLT:
    221      1.1  jakllsch 			rval = urndis_ctrl_handle_query(sc, hdr, buf, bufsz);
    222      1.1  jakllsch 			break;
    223      1.1  jakllsch 
    224      1.1  jakllsch 		case REMOTE_NDIS_RESET_CMPLT:
    225      1.1  jakllsch 			rval = urndis_ctrl_handle_reset(sc, hdr);
    226      1.1  jakllsch 			break;
    227      1.1  jakllsch 
    228      1.1  jakllsch 		case REMOTE_NDIS_KEEPALIVE_CMPLT:
    229      1.1  jakllsch 		case REMOTE_NDIS_SET_CMPLT:
    230      1.1  jakllsch 			rval = le32toh(hdr->rm_status);
    231      1.1  jakllsch 			break;
    232      1.1  jakllsch 
    233      1.1  jakllsch 		default:
    234      1.1  jakllsch 			printf("%s: ctrl message error: unknown event 0x%x\n",
    235      1.1  jakllsch 			    DEVNAME(sc), le32toh(hdr->rm_type));
    236      1.1  jakllsch 			rval = RNDIS_STATUS_FAILURE;
    237      1.1  jakllsch 	}
    238      1.1  jakllsch 
    239      1.1  jakllsch 	kmem_free(hdr, URNDIS_RESPONSE_LEN);
    240      1.1  jakllsch 
    241      1.1  jakllsch 	return rval;
    242      1.1  jakllsch }
    243      1.1  jakllsch 
    244      1.1  jakllsch static uint32_t
    245      1.1  jakllsch urndis_ctrl_handle_init(struct urndis_softc *sc,
    246      1.1  jakllsch     const struct urndis_comp_hdr *hdr)
    247      1.1  jakllsch {
    248      1.1  jakllsch 	const struct urndis_init_comp	*msg;
    249      1.1  jakllsch 
    250      1.1  jakllsch 	msg = (const struct urndis_init_comp *) hdr;
    251      1.1  jakllsch 
    252      1.1  jakllsch 	DPRINTF(("%s: urndis_ctrl_handle_init: len %u rid %u status 0x%x "
    253      1.1  jakllsch 	    "ver_major %u ver_minor %u devflags 0x%x medium 0x%x pktmaxcnt %u "
    254      1.1  jakllsch 	    "pktmaxsz %u align %u aflistoffset %u aflistsz %u\n",
    255      1.1  jakllsch 	    DEVNAME(sc),
    256      1.1  jakllsch 	    le32toh(msg->rm_len),
    257      1.1  jakllsch 	    le32toh(msg->rm_rid),
    258      1.1  jakllsch 	    le32toh(msg->rm_status),
    259      1.1  jakllsch 	    le32toh(msg->rm_ver_major),
    260      1.1  jakllsch 	    le32toh(msg->rm_ver_minor),
    261      1.1  jakllsch 	    le32toh(msg->rm_devflags),
    262      1.1  jakllsch 	    le32toh(msg->rm_medium),
    263      1.1  jakllsch 	    le32toh(msg->rm_pktmaxcnt),
    264      1.1  jakllsch 	    le32toh(msg->rm_pktmaxsz),
    265      1.1  jakllsch 	    le32toh(msg->rm_align),
    266      1.1  jakllsch 	    le32toh(msg->rm_aflistoffset),
    267      1.1  jakllsch 	    le32toh(msg->rm_aflistsz)));
    268      1.1  jakllsch 
    269      1.1  jakllsch 	if (le32toh(msg->rm_status) != RNDIS_STATUS_SUCCESS) {
    270      1.1  jakllsch 		printf("%s: init failed 0x%x\n",
    271      1.1  jakllsch 		    DEVNAME(sc),
    272      1.1  jakllsch 		    le32toh(msg->rm_status));
    273      1.1  jakllsch 
    274      1.1  jakllsch 		return le32toh(msg->rm_status);
    275      1.1  jakllsch 	}
    276      1.1  jakllsch 
    277      1.1  jakllsch 	if (le32toh(msg->rm_devflags) != RNDIS_DF_CONNECTIONLESS) {
    278      1.1  jakllsch 		printf("%s: wrong device type (current type: 0x%x)\n",
    279      1.1  jakllsch 		    DEVNAME(sc),
    280      1.1  jakllsch 		    le32toh(msg->rm_devflags));
    281      1.1  jakllsch 
    282      1.1  jakllsch 		return RNDIS_STATUS_FAILURE;
    283      1.1  jakllsch 	}
    284      1.1  jakllsch 
    285      1.1  jakllsch 	if (le32toh(msg->rm_medium) != RNDIS_MEDIUM_802_3) {
    286      1.1  jakllsch 		printf("%s: medium not 802.3 (current medium: 0x%x)\n",
    287      1.1  jakllsch 		    DEVNAME(sc), le32toh(msg->rm_medium));
    288      1.1  jakllsch 
    289      1.1  jakllsch 		return RNDIS_STATUS_FAILURE;
    290      1.1  jakllsch 	}
    291      1.1  jakllsch 
    292      1.1  jakllsch 	sc->sc_lim_pktsz = le32toh(msg->rm_pktmaxsz);
    293      1.1  jakllsch 
    294      1.1  jakllsch 	return le32toh(msg->rm_status);
    295      1.1  jakllsch }
    296      1.1  jakllsch 
    297      1.1  jakllsch static uint32_t
    298      1.1  jakllsch urndis_ctrl_handle_query(struct urndis_softc *sc,
    299      1.1  jakllsch     const struct urndis_comp_hdr *hdr, void **buf, size_t *bufsz)
    300      1.1  jakllsch {
    301      1.1  jakllsch 	const struct urndis_query_comp	*msg;
    302      1.1  jakllsch 
    303      1.1  jakllsch 	msg = (const struct urndis_query_comp *) hdr;
    304      1.1  jakllsch 
    305      1.1  jakllsch 	DPRINTF(("%s: urndis_ctrl_handle_query: len %u rid %u status 0x%x "
    306      1.1  jakllsch 	    "buflen %u bufoff %u\n",
    307      1.1  jakllsch 	    DEVNAME(sc),
    308      1.1  jakllsch 	    le32toh(msg->rm_len),
    309      1.1  jakllsch 	    le32toh(msg->rm_rid),
    310      1.1  jakllsch 	    le32toh(msg->rm_status),
    311      1.1  jakllsch 	    le32toh(msg->rm_infobuflen),
    312      1.1  jakllsch 	    le32toh(msg->rm_infobufoffset)));
    313      1.1  jakllsch 
    314      1.1  jakllsch 	if (buf && bufsz) {
    315      1.1  jakllsch 		*buf = NULL;
    316      1.1  jakllsch 		*bufsz = 0;
    317      1.1  jakllsch 	}
    318      1.1  jakllsch 
    319      1.1  jakllsch 	if (le32toh(msg->rm_status) != RNDIS_STATUS_SUCCESS) {
    320      1.1  jakllsch 		printf("%s: query failed 0x%x\n",
    321      1.1  jakllsch 		    DEVNAME(sc),
    322      1.1  jakllsch 		    le32toh(msg->rm_status));
    323      1.1  jakllsch 
    324      1.1  jakllsch 		return le32toh(msg->rm_status);
    325      1.1  jakllsch 	}
    326      1.1  jakllsch 
    327      1.1  jakllsch 	if (le32toh(msg->rm_infobuflen) + le32toh(msg->rm_infobufoffset) +
    328      1.1  jakllsch 	    RNDIS_HEADER_OFFSET > le32toh(msg->rm_len)) {
    329      1.1  jakllsch 		printf("%s: ctrl message error: invalid query info "
    330      1.1  jakllsch 		    "len/offset/end_position(%u/%u/%u) -> "
    331      1.1  jakllsch 		    "go out of buffer limit %u\n",
    332      1.1  jakllsch 		    DEVNAME(sc),
    333      1.1  jakllsch 		    le32toh(msg->rm_infobuflen),
    334  1.4.2.1       tls 		    le32toh(msg->rm_infobufoffset),
    335      1.1  jakllsch 		    le32toh(msg->rm_infobuflen) +
    336      1.1  jakllsch 		    le32toh(msg->rm_infobufoffset) + (uint32_t)RNDIS_HEADER_OFFSET,
    337      1.1  jakllsch 		    le32toh(msg->rm_len));
    338      1.1  jakllsch 		return RNDIS_STATUS_FAILURE;
    339      1.1  jakllsch 	}
    340      1.1  jakllsch 
    341      1.1  jakllsch 	if (buf && bufsz) {
    342  1.4.2.3  jdolecek 		const char *p;
    343  1.4.2.3  jdolecek 
    344      1.1  jakllsch 		*buf = kmem_alloc(le32toh(msg->rm_infobuflen), KM_SLEEP);
    345  1.4.2.3  jdolecek 		*bufsz = le32toh(msg->rm_infobuflen);
    346      1.1  jakllsch 
    347  1.4.2.3  jdolecek 		p = (const char *)&msg->rm_rid;
    348  1.4.2.3  jdolecek 		p += le32toh(msg->rm_infobufoffset);
    349  1.4.2.3  jdolecek 		memcpy(*buf, p, le32toh(msg->rm_infobuflen));
    350      1.1  jakllsch 	}
    351      1.1  jakllsch 
    352      1.1  jakllsch 	return le32toh(msg->rm_status);
    353      1.1  jakllsch }
    354      1.1  jakllsch 
    355      1.1  jakllsch static uint32_t
    356      1.1  jakllsch urndis_ctrl_handle_reset(struct urndis_softc *sc,
    357      1.1  jakllsch     const struct urndis_comp_hdr *hdr)
    358      1.1  jakllsch {
    359      1.1  jakllsch 	const struct urndis_reset_comp	*msg;
    360      1.1  jakllsch 	uint32_t			 rval;
    361      1.1  jakllsch 
    362      1.1  jakllsch 	msg = (const struct urndis_reset_comp *) hdr;
    363      1.1  jakllsch 
    364      1.1  jakllsch 	rval = le32toh(msg->rm_status);
    365      1.1  jakllsch 
    366      1.1  jakllsch 	DPRINTF(("%s: urndis_ctrl_handle_reset: len %u status 0x%x "
    367      1.1  jakllsch 	    "adrreset %u\n",
    368      1.1  jakllsch 	    DEVNAME(sc),
    369      1.1  jakllsch 	    le32toh(msg->rm_len),
    370      1.1  jakllsch 	    rval,
    371      1.1  jakllsch 	    le32toh(msg->rm_adrreset)));
    372      1.1  jakllsch 
    373      1.1  jakllsch 	if (rval != RNDIS_STATUS_SUCCESS) {
    374      1.1  jakllsch 		printf("%s: reset failed 0x%x\n", DEVNAME(sc), rval);
    375      1.1  jakllsch 		return rval;
    376      1.1  jakllsch 	}
    377      1.1  jakllsch 
    378      1.1  jakllsch 	if (le32toh(msg->rm_adrreset) != 0) {
    379      1.1  jakllsch 		uint32_t filter;
    380      1.1  jakllsch 
    381      1.1  jakllsch 		filter = htole32(sc->sc_filter);
    382      1.1  jakllsch 		rval = urndis_ctrl_set(sc, OID_GEN_CURRENT_PACKET_FILTER,
    383      1.1  jakllsch 		    &filter, sizeof(filter));
    384      1.1  jakllsch 		if (rval != RNDIS_STATUS_SUCCESS) {
    385      1.1  jakllsch 			printf("%s: unable to reset data filters\n",
    386      1.1  jakllsch 			    DEVNAME(sc));
    387      1.1  jakllsch 			return rval;
    388      1.1  jakllsch 		}
    389      1.1  jakllsch 	}
    390      1.1  jakllsch 
    391      1.1  jakllsch 	return rval;
    392      1.1  jakllsch }
    393      1.1  jakllsch 
    394      1.1  jakllsch static uint32_t
    395      1.1  jakllsch urndis_ctrl_init(struct urndis_softc *sc)
    396      1.1  jakllsch {
    397      1.1  jakllsch 	struct urndis_init_req	*msg;
    398      1.1  jakllsch 	uint32_t		 rval;
    399      1.1  jakllsch 	struct urndis_comp_hdr	*hdr;
    400      1.1  jakllsch 
    401      1.1  jakllsch 	msg = kmem_alloc(sizeof(*msg), KM_SLEEP);
    402      1.1  jakllsch 	msg->rm_type = htole32(REMOTE_NDIS_INITIALIZE_MSG);
    403      1.1  jakllsch 	msg->rm_len = htole32(sizeof(*msg));
    404      1.1  jakllsch 	msg->rm_rid = htole32(0);
    405      1.1  jakllsch 	msg->rm_ver_major = htole32(1);
    406      1.1  jakllsch 	msg->rm_ver_minor = htole32(1);
    407      1.1  jakllsch 	msg->rm_max_xfersz = htole32(RNDIS_BUFSZ);
    408      1.1  jakllsch 
    409      1.1  jakllsch 	DPRINTF(("%s: urndis_ctrl_init send: type %u len %u rid %u ver_major %u "
    410      1.1  jakllsch 	    "ver_minor %u max_xfersz %u\n",
    411      1.1  jakllsch 	    DEVNAME(sc),
    412      1.1  jakllsch 	    le32toh(msg->rm_type),
    413      1.1  jakllsch 	    le32toh(msg->rm_len),
    414      1.1  jakllsch 	    le32toh(msg->rm_rid),
    415      1.1  jakllsch 	    le32toh(msg->rm_ver_major),
    416      1.1  jakllsch 	    le32toh(msg->rm_ver_minor),
    417      1.1  jakllsch 	    le32toh(msg->rm_max_xfersz)));
    418      1.1  jakllsch 
    419      1.1  jakllsch 	rval = urndis_ctrl_send(sc, msg, sizeof(*msg));
    420      1.1  jakllsch 	kmem_free(msg, sizeof(*msg));
    421      1.1  jakllsch 
    422      1.1  jakllsch 	if (rval != RNDIS_STATUS_SUCCESS) {
    423      1.1  jakllsch 		printf("%s: init failed\n", DEVNAME(sc));
    424      1.1  jakllsch 		return rval;
    425      1.1  jakllsch 	}
    426      1.1  jakllsch 
    427      1.1  jakllsch 	if ((hdr = urndis_ctrl_recv(sc)) == NULL) {
    428      1.1  jakllsch 		printf("%s: unable to get init response\n", DEVNAME(sc));
    429      1.1  jakllsch 		return RNDIS_STATUS_FAILURE;
    430      1.1  jakllsch 	}
    431      1.1  jakllsch 	rval = urndis_ctrl_handle(sc, hdr, NULL, NULL);
    432      1.1  jakllsch 
    433      1.1  jakllsch 	return rval;
    434      1.1  jakllsch }
    435      1.1  jakllsch 
    436      1.1  jakllsch #if 0
    437      1.1  jakllsch static uint32_t
    438      1.1  jakllsch urndis_ctrl_halt(struct urndis_softc *sc)
    439      1.1  jakllsch {
    440      1.1  jakllsch 	struct urndis_halt_req	*msg;
    441      1.1  jakllsch 	uint32_t		 rval;
    442      1.1  jakllsch 
    443      1.1  jakllsch 	msg = kmem_alloc(sizeof(*msg), KM_SLEEP);
    444      1.1  jakllsch 	msg->rm_type = htole32(REMOTE_NDIS_HALT_MSG);
    445      1.1  jakllsch 	msg->rm_len = htole32(sizeof(*msg));
    446      1.1  jakllsch 	msg->rm_rid = 0;
    447      1.1  jakllsch 
    448      1.1  jakllsch 	DPRINTF(("%s: urndis_ctrl_halt send: type %u len %u rid %u\n",
    449      1.1  jakllsch 	    DEVNAME(sc),
    450      1.1  jakllsch 	    le32toh(msg->rm_type),
    451      1.1  jakllsch 	    le32toh(msg->rm_len),
    452      1.1  jakllsch 	    le32toh(msg->rm_rid)));
    453      1.1  jakllsch 
    454      1.1  jakllsch 	rval = urndis_ctrl_send(sc, msg, sizeof(*msg));
    455      1.1  jakllsch 	kmem_free(msg, sizeof(*msg));
    456      1.1  jakllsch 
    457      1.1  jakllsch 	if (rval != RNDIS_STATUS_SUCCESS)
    458      1.1  jakllsch 		printf("%s: halt failed\n", DEVNAME(sc));
    459      1.1  jakllsch 
    460      1.1  jakllsch 	return rval;
    461      1.1  jakllsch }
    462      1.1  jakllsch #endif
    463      1.1  jakllsch 
    464      1.1  jakllsch static uint32_t
    465      1.1  jakllsch urndis_ctrl_query(struct urndis_softc *sc, uint32_t oid,
    466      1.1  jakllsch     void *qbuf, size_t qlen,
    467      1.1  jakllsch     void **rbuf, size_t *rbufsz)
    468      1.1  jakllsch {
    469      1.1  jakllsch 	struct urndis_query_req	*msg;
    470      1.1  jakllsch 	uint32_t		 rval;
    471      1.1  jakllsch 	struct urndis_comp_hdr	*hdr;
    472      1.1  jakllsch 
    473      1.1  jakllsch 	msg = kmem_alloc(sizeof(*msg) + qlen, KM_SLEEP);
    474      1.1  jakllsch 	msg->rm_type = htole32(REMOTE_NDIS_QUERY_MSG);
    475      1.1  jakllsch 	msg->rm_len = htole32(sizeof(*msg) + qlen);
    476      1.1  jakllsch 	msg->rm_rid = 0; /* XXX */
    477      1.1  jakllsch 	msg->rm_oid = htole32(oid);
    478      1.1  jakllsch 	msg->rm_infobuflen = htole32(qlen);
    479      1.1  jakllsch 	if (qlen != 0) {
    480      1.1  jakllsch 		msg->rm_infobufoffset = htole32(20);
    481      1.1  jakllsch 		memcpy((char*)msg + 20, qbuf, qlen);
    482      1.1  jakllsch 	} else
    483      1.1  jakllsch 		msg->rm_infobufoffset = 0;
    484      1.1  jakllsch 	msg->rm_devicevchdl = 0;
    485      1.1  jakllsch 
    486      1.1  jakllsch 	DPRINTF(("%s: urndis_ctrl_query send: type %u len %u rid %u oid 0x%x "
    487      1.1  jakllsch 	    "infobuflen %u infobufoffset %u devicevchdl %u\n",
    488      1.1  jakllsch 	    DEVNAME(sc),
    489      1.1  jakllsch 	    le32toh(msg->rm_type),
    490      1.1  jakllsch 	    le32toh(msg->rm_len),
    491      1.1  jakllsch 	    le32toh(msg->rm_rid),
    492      1.1  jakllsch 	    le32toh(msg->rm_oid),
    493      1.1  jakllsch 	    le32toh(msg->rm_infobuflen),
    494      1.1  jakllsch 	    le32toh(msg->rm_infobufoffset),
    495      1.1  jakllsch 	    le32toh(msg->rm_devicevchdl)));
    496      1.1  jakllsch 
    497      1.1  jakllsch 	rval = urndis_ctrl_send(sc, msg, sizeof(*msg));
    498  1.4.2.2       tls 	kmem_free(msg, sizeof(*msg) + qlen);
    499      1.1  jakllsch 
    500      1.1  jakllsch 	if (rval != RNDIS_STATUS_SUCCESS) {
    501      1.1  jakllsch 		printf("%s: query failed\n", DEVNAME(sc));
    502      1.1  jakllsch 		return rval;
    503      1.1  jakllsch 	}
    504      1.1  jakllsch 
    505      1.1  jakllsch 	if ((hdr = urndis_ctrl_recv(sc)) == NULL) {
    506      1.1  jakllsch 		printf("%s: unable to get query response\n", DEVNAME(sc));
    507      1.1  jakllsch 		return RNDIS_STATUS_FAILURE;
    508      1.1  jakllsch 	}
    509      1.1  jakllsch 	rval = urndis_ctrl_handle(sc, hdr, rbuf, rbufsz);
    510      1.1  jakllsch 
    511      1.1  jakllsch 	return rval;
    512      1.1  jakllsch }
    513      1.1  jakllsch 
    514      1.1  jakllsch static uint32_t
    515      1.1  jakllsch urndis_ctrl_set(struct urndis_softc *sc, uint32_t oid, void *buf, size_t len)
    516      1.1  jakllsch {
    517      1.1  jakllsch 	struct urndis_set_req	*msg;
    518      1.1  jakllsch 	uint32_t		 rval;
    519      1.1  jakllsch 	struct urndis_comp_hdr	*hdr;
    520      1.1  jakllsch 
    521      1.1  jakllsch 	msg = kmem_alloc(sizeof(*msg) + len, KM_SLEEP);
    522      1.1  jakllsch 	msg->rm_type = htole32(REMOTE_NDIS_SET_MSG);
    523      1.1  jakllsch 	msg->rm_len = htole32(sizeof(*msg) + len);
    524      1.1  jakllsch 	msg->rm_rid = 0; /* XXX */
    525      1.1  jakllsch 	msg->rm_oid = htole32(oid);
    526      1.1  jakllsch 	msg->rm_infobuflen = htole32(len);
    527      1.1  jakllsch 	if (len != 0) {
    528      1.1  jakllsch 		msg->rm_infobufoffset = htole32(20);
    529      1.1  jakllsch 		memcpy((char*)msg + 20, buf, len);
    530      1.1  jakllsch 	} else
    531      1.1  jakllsch 		msg->rm_infobufoffset = 0;
    532      1.1  jakllsch 	msg->rm_devicevchdl = 0;
    533      1.1  jakllsch 
    534      1.1  jakllsch 	DPRINTF(("%s: urndis_ctrl_set send: type %u len %u rid %u oid 0x%x "
    535      1.1  jakllsch 	    "infobuflen %u infobufoffset %u devicevchdl %u\n",
    536      1.1  jakllsch 	    DEVNAME(sc),
    537      1.1  jakllsch 	    le32toh(msg->rm_type),
    538      1.1  jakllsch 	    le32toh(msg->rm_len),
    539      1.1  jakllsch 	    le32toh(msg->rm_rid),
    540      1.1  jakllsch 	    le32toh(msg->rm_oid),
    541      1.1  jakllsch 	    le32toh(msg->rm_infobuflen),
    542      1.1  jakllsch 	    le32toh(msg->rm_infobufoffset),
    543      1.1  jakllsch 	    le32toh(msg->rm_devicevchdl)));
    544      1.1  jakllsch 
    545      1.1  jakllsch 	rval = urndis_ctrl_send(sc, msg, sizeof(*msg));
    546  1.4.2.2       tls 	kmem_free(msg, sizeof(*msg) + len);
    547      1.1  jakllsch 
    548      1.1  jakllsch 	if (rval != RNDIS_STATUS_SUCCESS) {
    549      1.1  jakllsch 		printf("%s: set failed\n", DEVNAME(sc));
    550      1.1  jakllsch 		return rval;
    551      1.1  jakllsch 	}
    552      1.1  jakllsch 
    553      1.1  jakllsch 	if ((hdr = urndis_ctrl_recv(sc)) == NULL) {
    554      1.1  jakllsch 		printf("%s: unable to get set response\n", DEVNAME(sc));
    555      1.1  jakllsch 		return RNDIS_STATUS_FAILURE;
    556      1.1  jakllsch 	}
    557      1.1  jakllsch 	rval = urndis_ctrl_handle(sc, hdr, NULL, NULL);
    558      1.1  jakllsch 	if (rval != RNDIS_STATUS_SUCCESS)
    559      1.1  jakllsch 		printf("%s: set failed 0x%x\n", DEVNAME(sc), rval);
    560  1.4.2.1       tls 
    561      1.1  jakllsch 	return rval;
    562      1.1  jakllsch }
    563      1.1  jakllsch 
    564      1.1  jakllsch #if 0
    565      1.1  jakllsch static uint32_t
    566      1.1  jakllsch urndis_ctrl_set_param(struct urndis_softc *sc,
    567      1.1  jakllsch     const char *name,
    568      1.1  jakllsch     uint32_t type,
    569      1.1  jakllsch     void *buf,
    570      1.1  jakllsch     size_t len)
    571      1.1  jakllsch {
    572      1.1  jakllsch 	struct urndis_set_parameter	*param;
    573      1.1  jakllsch 	uint32_t			 rval;
    574      1.1  jakllsch 	size_t				 namelen, tlen;
    575      1.1  jakllsch 
    576      1.1  jakllsch 	if (name)
    577      1.1  jakllsch 		namelen = strlen(name);
    578      1.1  jakllsch 	else
    579      1.1  jakllsch 		namelen = 0;
    580      1.1  jakllsch 	tlen = sizeof(*param) + len + namelen;
    581      1.1  jakllsch 	param = kmem_alloc(tlen, KM_SLEEP);
    582      1.1  jakllsch 	param->rm_namelen = htole32(namelen);
    583      1.1  jakllsch 	param->rm_valuelen = htole32(len);
    584      1.1  jakllsch 	param->rm_type = htole32(type);
    585      1.1  jakllsch 	if (namelen != 0) {
    586      1.1  jakllsch 		param->rm_nameoffset = htole32(20);
    587      1.1  jakllsch 		memcpy(param + 20, name, namelen);
    588      1.1  jakllsch 	} else
    589      1.1  jakllsch 		param->rm_nameoffset = 0;
    590      1.1  jakllsch 	if (len != 0) {
    591      1.1  jakllsch 		param->rm_valueoffset = htole32(20 + namelen);
    592      1.1  jakllsch 		memcpy(param + 20 + namelen, buf, len);
    593      1.1  jakllsch 	} else
    594      1.1  jakllsch 		param->rm_valueoffset = 0;
    595      1.1  jakllsch 
    596      1.1  jakllsch 	DPRINTF(("%s: urndis_ctrl_set_param send: nameoffset %u namelen %u "
    597      1.1  jakllsch 	    "type 0x%x valueoffset %u valuelen %u\n",
    598      1.1  jakllsch 	    DEVNAME(sc),
    599      1.1  jakllsch 	    le32toh(param->rm_nameoffset),
    600      1.1  jakllsch 	    le32toh(param->rm_namelen),
    601      1.1  jakllsch 	    le32toh(param->rm_type),
    602      1.1  jakllsch 	    le32toh(param->rm_valueoffset),
    603      1.1  jakllsch 	    le32toh(param->rm_valuelen)));
    604      1.1  jakllsch 
    605      1.1  jakllsch 	rval = urndis_ctrl_set(sc, OID_GEN_RNDIS_CONFIG_PARAMETER, param, tlen);
    606      1.1  jakllsch 	kmem_free(param, tlen);
    607      1.1  jakllsch 	if (rval != RNDIS_STATUS_SUCCESS)
    608      1.1  jakllsch 		printf("%s: set param failed 0x%x\n", DEVNAME(sc), rval);
    609      1.1  jakllsch 
    610      1.1  jakllsch 	return rval;
    611      1.1  jakllsch }
    612      1.1  jakllsch 
    613      1.1  jakllsch /* XXX : adrreset, get it from response */
    614      1.1  jakllsch static uint32_t
    615      1.1  jakllsch urndis_ctrl_reset(struct urndis_softc *sc)
    616      1.1  jakllsch {
    617      1.1  jakllsch 	struct urndis_reset_req		*reset;
    618      1.1  jakllsch 	uint32_t			 rval;
    619      1.1  jakllsch 	struct urndis_comp_hdr		*hdr;
    620      1.1  jakllsch 
    621      1.1  jakllsch 	reset = kmem_alloc(sizeof(*reset), KM_SLEEP);
    622      1.1  jakllsch 	reset->rm_type = htole32(REMOTE_NDIS_RESET_MSG);
    623      1.1  jakllsch 	reset->rm_len = htole32(sizeof(*reset));
    624      1.1  jakllsch 	reset->rm_rid = 0; /* XXX rm_rid == reserved ... remove ? */
    625      1.1  jakllsch 
    626      1.1  jakllsch 	DPRINTF(("%s: urndis_ctrl_reset send: type %u len %u rid %u\n",
    627      1.1  jakllsch 	    DEVNAME(sc),
    628      1.1  jakllsch 	    le32toh(reset->rm_type),
    629      1.1  jakllsch 	    le32toh(reset->rm_len),
    630      1.1  jakllsch 	    le32toh(reset->rm_rid)));
    631      1.1  jakllsch 
    632      1.1  jakllsch 	rval = urndis_ctrl_send(sc, reset, sizeof(*reset));
    633      1.1  jakllsch 	kmem_free(reset, sizeof(*reset));
    634      1.1  jakllsch 
    635      1.1  jakllsch 	if (rval != RNDIS_STATUS_SUCCESS) {
    636      1.1  jakllsch 		printf("%s: reset failed\n", DEVNAME(sc));
    637      1.1  jakllsch 		return rval;
    638      1.1  jakllsch 	}
    639      1.1  jakllsch 
    640      1.1  jakllsch 	if ((hdr = urndis_ctrl_recv(sc)) == NULL) {
    641      1.1  jakllsch 		printf("%s: unable to get reset response\n", DEVNAME(sc));
    642      1.1  jakllsch 		return RNDIS_STATUS_FAILURE;
    643      1.1  jakllsch 	}
    644      1.1  jakllsch 	rval = urndis_ctrl_handle(sc, hdr, NULL, NULL);
    645      1.1  jakllsch 
    646      1.1  jakllsch 	return rval;
    647      1.1  jakllsch }
    648      1.1  jakllsch 
    649      1.1  jakllsch static uint32_t
    650      1.1  jakllsch urndis_ctrl_keepalive(struct urndis_softc *sc)
    651      1.1  jakllsch {
    652      1.1  jakllsch 	struct urndis_keepalive_req	*keep;
    653      1.1  jakllsch 	uint32_t			 rval;
    654      1.1  jakllsch 	struct urndis_comp_hdr		*hdr;
    655      1.1  jakllsch 
    656      1.1  jakllsch 	keep = kmem_alloc(sizeof(*keep), KM_SLEEP);
    657      1.1  jakllsch 	keep->rm_type = htole32(REMOTE_NDIS_KEEPALIVE_MSG);
    658      1.1  jakllsch 	keep->rm_len = htole32(sizeof(*keep));
    659      1.1  jakllsch 	keep->rm_rid = 0; /* XXX rm_rid == reserved ... remove ? */
    660      1.1  jakllsch 
    661      1.1  jakllsch 	DPRINTF(("%s: urndis_ctrl_keepalive: type %u len %u rid %u\n",
    662      1.1  jakllsch 	    DEVNAME(sc),
    663      1.1  jakllsch 	    le32toh(keep->rm_type),
    664      1.1  jakllsch 	    le32toh(keep->rm_len),
    665      1.1  jakllsch 	    le32toh(keep->rm_rid)));
    666      1.1  jakllsch 
    667      1.1  jakllsch 	rval = urndis_ctrl_send(sc, keep, sizeof(*keep));
    668      1.1  jakllsch 	kmem_free(keep, sizeof(*keep));
    669      1.1  jakllsch 
    670      1.1  jakllsch 	if (rval != RNDIS_STATUS_SUCCESS) {
    671      1.1  jakllsch 		printf("%s: keepalive failed\n", DEVNAME(sc));
    672      1.1  jakllsch 		return rval;
    673      1.1  jakllsch 	}
    674      1.1  jakllsch 
    675      1.1  jakllsch 	if ((hdr = urndis_ctrl_recv(sc)) == NULL) {
    676      1.1  jakllsch 		printf("%s: unable to get keepalive response\n", DEVNAME(sc));
    677      1.1  jakllsch 		return RNDIS_STATUS_FAILURE;
    678      1.1  jakllsch 	}
    679      1.1  jakllsch 	rval = urndis_ctrl_handle(sc, hdr, NULL, NULL);
    680      1.1  jakllsch 	if (rval != RNDIS_STATUS_SUCCESS) {
    681      1.1  jakllsch 		printf("%s: keepalive failed 0x%x\n", DEVNAME(sc), rval);
    682      1.1  jakllsch 		urndis_ctrl_reset(sc);
    683      1.1  jakllsch 	}
    684      1.1  jakllsch 
    685      1.1  jakllsch 	return rval;
    686      1.1  jakllsch }
    687      1.1  jakllsch #endif
    688      1.1  jakllsch 
    689      1.1  jakllsch static int
    690      1.1  jakllsch urndis_encap(struct urndis_softc *sc, struct mbuf *m, int idx)
    691      1.1  jakllsch {
    692      1.1  jakllsch 	struct urndis_chain		*c;
    693      1.1  jakllsch 	usbd_status			 err;
    694  1.4.2.3  jdolecek 	struct urndis_packet_msg	*msg;
    695      1.1  jakllsch 
    696      1.1  jakllsch 	c = &sc->sc_data.sc_tx_chain[idx];
    697      1.1  jakllsch 
    698      1.1  jakllsch 	msg = (struct urndis_packet_msg *)c->sc_buf;
    699      1.1  jakllsch 
    700      1.1  jakllsch 	memset(msg, 0, sizeof(*msg));
    701      1.1  jakllsch 	msg->rm_type = htole32(REMOTE_NDIS_PACKET_MSG);
    702      1.1  jakllsch 	msg->rm_len = htole32(sizeof(*msg) + m->m_pkthdr.len);
    703      1.1  jakllsch 
    704      1.1  jakllsch 	msg->rm_dataoffset = htole32(RNDIS_DATA_OFFSET);
    705      1.1  jakllsch 	msg->rm_datalen = htole32(m->m_pkthdr.len);
    706      1.1  jakllsch 
    707      1.1  jakllsch 	m_copydata(m, 0, m->m_pkthdr.len,
    708      1.1  jakllsch 	    ((char*)msg + RNDIS_DATA_OFFSET + RNDIS_HEADER_OFFSET));
    709      1.1  jakllsch 
    710      1.1  jakllsch 	DPRINTF(("%s: urndis_encap type 0x%x len %u data(off %u len %u)\n",
    711      1.1  jakllsch 	    DEVNAME(sc),
    712      1.1  jakllsch 	    le32toh(msg->rm_type),
    713      1.1  jakllsch 	    le32toh(msg->rm_len),
    714      1.1  jakllsch 	    le32toh(msg->rm_dataoffset),
    715      1.1  jakllsch 	    le32toh(msg->rm_datalen)));
    716      1.1  jakllsch 
    717      1.1  jakllsch 	c->sc_mbuf = m;
    718      1.1  jakllsch 
    719  1.4.2.3  jdolecek 	usbd_setup_xfer(c->sc_xfer, c, c->sc_buf, le32toh(msg->rm_len),
    720  1.4.2.3  jdolecek 	    USBD_FORCE_SHORT_XFER, 10000, urndis_txeof);
    721      1.1  jakllsch 
    722      1.1  jakllsch 	/* Transmit */
    723      1.1  jakllsch 	err = usbd_transfer(c->sc_xfer);
    724      1.1  jakllsch 	if (err != USBD_IN_PROGRESS) {
    725      1.1  jakllsch 		urndis_stop(GET_IFP(sc));
    726      1.1  jakllsch 		return(EIO);
    727      1.1  jakllsch 	}
    728      1.1  jakllsch 
    729      1.1  jakllsch 	sc->sc_data.sc_tx_cnt++;
    730      1.1  jakllsch 
    731      1.1  jakllsch 	return(0);
    732      1.1  jakllsch }
    733      1.1  jakllsch 
    734      1.1  jakllsch static void
    735      1.1  jakllsch urndis_decap(struct urndis_softc *sc, struct urndis_chain *c, uint32_t len)
    736      1.1  jakllsch {
    737      1.1  jakllsch 	struct mbuf		*m;
    738      1.1  jakllsch 	struct urndis_packet_msg	*msg;
    739      1.1  jakllsch 	struct ifnet		*ifp;
    740      1.1  jakllsch 	int			 s;
    741      1.1  jakllsch 	int			 offset;
    742      1.1  jakllsch 
    743      1.1  jakllsch 	ifp = GET_IFP(sc);
    744      1.1  jakllsch 	offset = 0;
    745  1.4.2.1       tls 
    746      1.1  jakllsch 	while (len > 0) {
    747      1.1  jakllsch 		msg = (struct urndis_packet_msg *)((char*)c->sc_buf + offset);
    748      1.1  jakllsch 		m = c->sc_mbuf;
    749      1.1  jakllsch 
    750      1.1  jakllsch 		DPRINTF(("%s: urndis_decap buffer size left %u\n", DEVNAME(sc),
    751      1.1  jakllsch 		    len));
    752      1.1  jakllsch 
    753      1.1  jakllsch 		if (len < sizeof(*msg)) {
    754      1.1  jakllsch 			printf("%s: urndis_decap invalid buffer len %u < "
    755      1.1  jakllsch 			    "minimum header %zu\n",
    756      1.1  jakllsch 			    DEVNAME(sc),
    757      1.1  jakllsch 			    len,
    758      1.1  jakllsch 			    sizeof(*msg));
    759      1.1  jakllsch 			return;
    760      1.1  jakllsch 		}
    761      1.1  jakllsch 
    762      1.1  jakllsch 		DPRINTF(("%s: urndis_decap len %u data(off:%u len:%u) "
    763      1.1  jakllsch 		    "oobdata(off:%u len:%u nb:%u) perpacket(off:%u len:%u)\n",
    764      1.1  jakllsch 		    DEVNAME(sc),
    765      1.1  jakllsch 		    le32toh(msg->rm_len),
    766      1.1  jakllsch 		    le32toh(msg->rm_dataoffset),
    767      1.1  jakllsch 		    le32toh(msg->rm_datalen),
    768      1.1  jakllsch 		    le32toh(msg->rm_oobdataoffset),
    769      1.1  jakllsch 		    le32toh(msg->rm_oobdatalen),
    770      1.1  jakllsch 		    le32toh(msg->rm_oobdataelements),
    771      1.1  jakllsch 		    le32toh(msg->rm_pktinfooffset),
    772      1.1  jakllsch 		    le32toh(msg->rm_pktinfooffset)));
    773      1.1  jakllsch 
    774      1.1  jakllsch 		if (le32toh(msg->rm_type) != REMOTE_NDIS_PACKET_MSG) {
    775      1.1  jakllsch 			printf("%s: urndis_decap invalid type 0x%x != 0x%x\n",
    776      1.1  jakllsch 			    DEVNAME(sc),
    777      1.1  jakllsch 			    le32toh(msg->rm_type),
    778      1.1  jakllsch 			    REMOTE_NDIS_PACKET_MSG);
    779      1.1  jakllsch 			return;
    780      1.1  jakllsch 		}
    781      1.1  jakllsch 		if (le32toh(msg->rm_len) < sizeof(*msg)) {
    782      1.1  jakllsch 			printf("%s: urndis_decap invalid msg len %u < %zu\n",
    783      1.1  jakllsch 			    DEVNAME(sc),
    784      1.1  jakllsch 			    le32toh(msg->rm_len),
    785      1.1  jakllsch 			    sizeof(*msg));
    786      1.1  jakllsch 			return;
    787      1.1  jakllsch 		}
    788      1.1  jakllsch 		if (le32toh(msg->rm_len) > len) {
    789      1.1  jakllsch 			printf("%s: urndis_decap invalid msg len %u > buffer "
    790      1.1  jakllsch 			    "len %u\n",
    791      1.1  jakllsch 			    DEVNAME(sc),
    792      1.1  jakllsch 			    le32toh(msg->rm_len),
    793      1.1  jakllsch 			    len);
    794      1.1  jakllsch 			return;
    795      1.1  jakllsch 		}
    796      1.1  jakllsch 
    797      1.1  jakllsch 		if (le32toh(msg->rm_dataoffset) +
    798  1.4.2.1       tls 		    le32toh(msg->rm_datalen) + RNDIS_HEADER_OFFSET
    799      1.1  jakllsch 		        > le32toh(msg->rm_len)) {
    800      1.1  jakllsch 			printf("%s: urndis_decap invalid data "
    801      1.1  jakllsch 			    "len/offset/end_position(%u/%u/%u) -> "
    802      1.1  jakllsch 			    "go out of receive buffer limit %u\n",
    803      1.1  jakllsch 			    DEVNAME(sc),
    804      1.1  jakllsch 			    le32toh(msg->rm_datalen),
    805      1.1  jakllsch 			    le32toh(msg->rm_dataoffset),
    806      1.1  jakllsch 			    le32toh(msg->rm_dataoffset) +
    807      1.1  jakllsch 			    le32toh(msg->rm_datalen) + (uint32_t)RNDIS_HEADER_OFFSET,
    808      1.1  jakllsch 			    le32toh(msg->rm_len));
    809      1.1  jakllsch 			return;
    810      1.1  jakllsch 		}
    811      1.1  jakllsch 
    812      1.1  jakllsch 		if (le32toh(msg->rm_datalen) < sizeof(struct ether_header)) {
    813      1.1  jakllsch 			ifp->if_ierrors++;
    814      1.1  jakllsch 			printf("%s: urndis_decap invalid ethernet size "
    815      1.1  jakllsch 			    "%d < %zu\n",
    816      1.1  jakllsch 			    DEVNAME(sc),
    817      1.1  jakllsch 			    le32toh(msg->rm_datalen),
    818      1.1  jakllsch 			    sizeof(struct ether_header));
    819      1.1  jakllsch 			return;
    820      1.1  jakllsch 		}
    821      1.1  jakllsch 
    822      1.1  jakllsch 		memcpy(mtod(m, char*),
    823      1.1  jakllsch 		    ((char*)&msg->rm_dataoffset + le32toh(msg->rm_dataoffset)),
    824      1.1  jakllsch 		    le32toh(msg->rm_datalen));
    825      1.1  jakllsch 		m->m_pkthdr.len = m->m_len = le32toh(msg->rm_datalen);
    826      1.1  jakllsch 
    827  1.4.2.3  jdolecek 		m_set_rcvif(m, ifp);
    828      1.1  jakllsch 
    829      1.1  jakllsch 		s = splnet();
    830      1.1  jakllsch 
    831      1.1  jakllsch 		if (urndis_newbuf(sc, c) == ENOBUFS) {
    832      1.1  jakllsch 			ifp->if_ierrors++;
    833      1.1  jakllsch 		} else {
    834  1.4.2.3  jdolecek 			if_percpuq_enqueue(ifp->if_percpuq, m);
    835      1.1  jakllsch 		}
    836      1.1  jakllsch 		splx(s);
    837      1.1  jakllsch 
    838      1.1  jakllsch 		offset += le32toh(msg->rm_len);
    839      1.1  jakllsch 		len -= le32toh(msg->rm_len);
    840      1.1  jakllsch 	}
    841      1.1  jakllsch }
    842      1.1  jakllsch 
    843      1.1  jakllsch static int
    844      1.1  jakllsch urndis_newbuf(struct urndis_softc *sc, struct urndis_chain *c)
    845      1.1  jakllsch {
    846      1.1  jakllsch 	struct mbuf *m_new = NULL;
    847      1.1  jakllsch 
    848      1.1  jakllsch 	MGETHDR(m_new, M_DONTWAIT, MT_DATA);
    849      1.1  jakllsch 	if (m_new == NULL) {
    850      1.1  jakllsch 		printf("%s: no memory for rx list -- packet dropped!\n",
    851      1.1  jakllsch 		    DEVNAME(sc));
    852  1.4.2.3  jdolecek 		return ENOBUFS;
    853      1.1  jakllsch 	}
    854      1.1  jakllsch 	MCLGET(m_new, M_DONTWAIT);
    855      1.1  jakllsch 	if (!(m_new->m_flags & M_EXT)) {
    856      1.1  jakllsch 		printf("%s: no memory for rx list -- packet dropped!\n",
    857      1.1  jakllsch 		    DEVNAME(sc));
    858      1.1  jakllsch 		m_freem(m_new);
    859  1.4.2.3  jdolecek 		return ENOBUFS;
    860      1.1  jakllsch 	}
    861      1.1  jakllsch 	m_new->m_len = m_new->m_pkthdr.len = MCLBYTES;
    862      1.1  jakllsch 
    863      1.1  jakllsch 	m_adj(m_new, ETHER_ALIGN);
    864      1.1  jakllsch 	c->sc_mbuf = m_new;
    865  1.4.2.3  jdolecek 	return 0;
    866      1.1  jakllsch }
    867      1.1  jakllsch 
    868      1.1  jakllsch static int
    869      1.1  jakllsch urndis_rx_list_init(struct urndis_softc *sc)
    870      1.1  jakllsch {
    871      1.1  jakllsch 	struct urndis_cdata	*cd;
    872      1.1  jakllsch 	struct urndis_chain	*c;
    873      1.1  jakllsch 	int			 i;
    874      1.1  jakllsch 
    875      1.1  jakllsch 	cd = &sc->sc_data;
    876      1.1  jakllsch 	for (i = 0; i < RNDIS_RX_LIST_CNT; i++) {
    877      1.1  jakllsch 		c = &cd->sc_rx_chain[i];
    878      1.1  jakllsch 		c->sc_softc = sc;
    879      1.1  jakllsch 		c->sc_idx = i;
    880      1.1  jakllsch 
    881      1.1  jakllsch 		if (urndis_newbuf(sc, c) == ENOBUFS)
    882  1.4.2.3  jdolecek 			return ENOBUFS;
    883      1.1  jakllsch 
    884      1.1  jakllsch 		if (c->sc_xfer == NULL) {
    885  1.4.2.3  jdolecek 			int err = usbd_create_xfer(sc->sc_bulkin_pipe,
    886  1.4.2.3  jdolecek 			    RNDIS_BUFSZ, USBD_SHORT_XFER_OK, 0, &c->sc_xfer);
    887  1.4.2.3  jdolecek 			if (err)
    888  1.4.2.3  jdolecek 				return err;
    889  1.4.2.3  jdolecek 			c->sc_buf = usbd_get_buffer(c->sc_xfer);
    890      1.1  jakllsch 		}
    891      1.1  jakllsch 	}
    892      1.1  jakllsch 
    893  1.4.2.3  jdolecek 	return 0;
    894      1.1  jakllsch }
    895      1.1  jakllsch 
    896      1.1  jakllsch static int
    897      1.1  jakllsch urndis_tx_list_init(struct urndis_softc *sc)
    898      1.1  jakllsch {
    899      1.1  jakllsch 	struct urndis_cdata	*cd;
    900      1.1  jakllsch 	struct urndis_chain	*c;
    901      1.1  jakllsch 	int			 i;
    902      1.1  jakllsch 
    903      1.1  jakllsch 	cd = &sc->sc_data;
    904      1.1  jakllsch 	for (i = 0; i < RNDIS_TX_LIST_CNT; i++) {
    905      1.1  jakllsch 		c = &cd->sc_tx_chain[i];
    906      1.1  jakllsch 		c->sc_softc = sc;
    907      1.1  jakllsch 		c->sc_idx = i;
    908      1.1  jakllsch 		c->sc_mbuf = NULL;
    909      1.1  jakllsch 		if (c->sc_xfer == NULL) {
    910  1.4.2.3  jdolecek 			int err = usbd_create_xfer(sc->sc_bulkout_pipe,
    911  1.4.2.3  jdolecek 			    RNDIS_BUFSZ, USBD_FORCE_SHORT_XFER, 0, &c->sc_xfer);
    912  1.4.2.3  jdolecek 			if (err)
    913  1.4.2.3  jdolecek 				return err;
    914  1.4.2.3  jdolecek 			c->sc_buf = usbd_get_buffer(c->sc_xfer);
    915      1.1  jakllsch 		}
    916      1.1  jakllsch 	}
    917  1.4.2.3  jdolecek 	return 0;
    918      1.1  jakllsch }
    919      1.1  jakllsch 
    920      1.1  jakllsch static int
    921      1.1  jakllsch urndis_ioctl(struct ifnet *ifp, unsigned long command, void *data)
    922      1.1  jakllsch {
    923      1.1  jakllsch 	struct urndis_softc	*sc;
    924      1.1  jakllsch 	int			 s, error;
    925      1.1  jakllsch 
    926      1.1  jakllsch 	sc = ifp->if_softc;
    927      1.1  jakllsch 	error = 0;
    928      1.1  jakllsch 
    929      1.1  jakllsch 	if (sc->sc_dying)
    930  1.4.2.3  jdolecek 		return EIO;
    931      1.1  jakllsch 
    932      1.1  jakllsch 	s = splnet();
    933      1.1  jakllsch 
    934      1.1  jakllsch 	switch(command) {
    935      1.1  jakllsch 	case SIOCSIFFLAGS:
    936      1.1  jakllsch 		if ((error = ifioctl_common(ifp, command, data)) != 0)
    937      1.1  jakllsch 			break;
    938      1.1  jakllsch 		if (ifp->if_flags & IFF_UP) {
    939      1.1  jakllsch 			if (!(ifp->if_flags & IFF_RUNNING))
    940      1.1  jakllsch 				urndis_init(ifp);
    941      1.1  jakllsch 		} else {
    942      1.1  jakllsch 			if (ifp->if_flags & IFF_RUNNING)
    943      1.1  jakllsch 				urndis_stop(ifp);
    944      1.1  jakllsch 		}
    945      1.1  jakllsch 		error = 0;
    946      1.1  jakllsch 		break;
    947      1.1  jakllsch 
    948      1.1  jakllsch 	default:
    949      1.1  jakllsch 		error = ether_ioctl(ifp, command, data);
    950      1.1  jakllsch 		break;
    951      1.1  jakllsch 	}
    952      1.1  jakllsch 
    953      1.1  jakllsch 	if (error == ENETRESET)
    954      1.1  jakllsch 		error = 0;
    955      1.1  jakllsch 
    956      1.1  jakllsch 	splx(s);
    957  1.4.2.3  jdolecek 	return error;
    958      1.1  jakllsch }
    959      1.1  jakllsch 
    960      1.1  jakllsch #if 0
    961      1.1  jakllsch static void
    962      1.1  jakllsch urndis_watchdog(struct ifnet *ifp)
    963      1.1  jakllsch {
    964      1.1  jakllsch 	struct urndis_softc *sc;
    965      1.1  jakllsch 
    966      1.1  jakllsch 	sc = ifp->if_softc;
    967      1.1  jakllsch 
    968      1.1  jakllsch 	if (sc->sc_dying)
    969      1.1  jakllsch 		return;
    970      1.1  jakllsch 
    971      1.1  jakllsch 	ifp->if_oerrors++;
    972      1.1  jakllsch 	printf("%s: watchdog timeout\n", DEVNAME(sc));
    973      1.1  jakllsch 
    974      1.1  jakllsch 	urndis_ctrl_keepalive(sc);
    975      1.1  jakllsch }
    976      1.1  jakllsch #endif
    977      1.1  jakllsch 
    978  1.4.2.2       tls static int
    979      1.1  jakllsch urndis_init(struct ifnet *ifp)
    980      1.1  jakllsch {
    981      1.1  jakllsch 	struct urndis_softc	*sc;
    982      1.1  jakllsch 	int			 i, s;
    983  1.4.2.2       tls 	int 			 err;
    984  1.4.2.2       tls 	usbd_status		 usberr;
    985      1.1  jakllsch 
    986      1.1  jakllsch 	sc = ifp->if_softc;
    987      1.1  jakllsch 
    988      1.1  jakllsch 	if (ifp->if_flags & IFF_RUNNING)
    989  1.4.2.2       tls 		return 0;
    990      1.1  jakllsch 
    991  1.4.2.2       tls 	err = urndis_ctrl_init(sc);
    992  1.4.2.2       tls 	if (err != RNDIS_STATUS_SUCCESS)
    993  1.4.2.2       tls 		return EIO;
    994      1.1  jakllsch 
    995      1.1  jakllsch 	s = splnet();
    996      1.1  jakllsch 
    997  1.4.2.2       tls 	usberr = usbd_open_pipe(sc->sc_iface_data, sc->sc_bulkin_no,
    998      1.1  jakllsch 	    USBD_EXCLUSIVE_USE, &sc->sc_bulkin_pipe);
    999  1.4.2.2       tls 	if (usberr) {
   1000      1.1  jakllsch 		printf("%s: open rx pipe failed: %s\n", DEVNAME(sc),
   1001      1.1  jakllsch 		    usbd_errstr(err));
   1002      1.1  jakllsch 		splx(s);
   1003  1.4.2.2       tls 		return EIO;
   1004      1.1  jakllsch 	}
   1005      1.1  jakllsch 
   1006  1.4.2.2       tls 	usberr = usbd_open_pipe(sc->sc_iface_data, sc->sc_bulkout_no,
   1007      1.1  jakllsch 	    USBD_EXCLUSIVE_USE, &sc->sc_bulkout_pipe);
   1008  1.4.2.2       tls 	if (usberr) {
   1009      1.1  jakllsch 		printf("%s: open tx pipe failed: %s\n", DEVNAME(sc),
   1010      1.1  jakllsch 		    usbd_errstr(err));
   1011      1.1  jakllsch 		splx(s);
   1012  1.4.2.2       tls 		return EIO;
   1013      1.1  jakllsch 	}
   1014      1.1  jakllsch 
   1015  1.4.2.3  jdolecek 	err = urndis_tx_list_init(sc);
   1016  1.4.2.3  jdolecek 	if (err) {
   1017  1.4.2.3  jdolecek 		printf("%s: tx list init failed\n",
   1018  1.4.2.3  jdolecek 		    DEVNAME(sc));
   1019  1.4.2.3  jdolecek 		splx(s);
   1020  1.4.2.3  jdolecek 		return err;
   1021  1.4.2.3  jdolecek 	}
   1022  1.4.2.3  jdolecek 
   1023  1.4.2.3  jdolecek 	err = urndis_rx_list_init(sc);
   1024  1.4.2.3  jdolecek 	if (err) {
   1025  1.4.2.3  jdolecek 		printf("%s: rx list init failed\n",
   1026  1.4.2.3  jdolecek 		    DEVNAME(sc));
   1027  1.4.2.3  jdolecek 		splx(s);
   1028  1.4.2.3  jdolecek 		return err;
   1029  1.4.2.3  jdolecek 	}
   1030  1.4.2.3  jdolecek 
   1031      1.1  jakllsch 	for (i = 0; i < RNDIS_RX_LIST_CNT; i++) {
   1032      1.1  jakllsch 		struct urndis_chain *c;
   1033      1.1  jakllsch 
   1034      1.1  jakllsch 		c = &sc->sc_data.sc_rx_chain[i];
   1035  1.4.2.3  jdolecek 
   1036  1.4.2.3  jdolecek 		usbd_setup_xfer(c->sc_xfer, c, c->sc_buf, RNDIS_BUFSZ,
   1037  1.4.2.3  jdolecek 		    USBD_SHORT_XFER_OK, USBD_NO_TIMEOUT, urndis_rxeof);
   1038      1.1  jakllsch 		usbd_transfer(c->sc_xfer);
   1039      1.1  jakllsch 	}
   1040      1.1  jakllsch 
   1041      1.1  jakllsch 	ifp->if_flags |= IFF_RUNNING;
   1042      1.1  jakllsch 	ifp->if_flags &= ~IFF_OACTIVE;
   1043      1.1  jakllsch 
   1044      1.1  jakllsch 	splx(s);
   1045  1.4.2.2       tls 	return 0;
   1046      1.1  jakllsch }
   1047      1.1  jakllsch 
   1048      1.1  jakllsch static void
   1049      1.1  jakllsch urndis_stop(struct ifnet *ifp)
   1050      1.1  jakllsch {
   1051      1.1  jakllsch 	struct urndis_softc	*sc;
   1052      1.1  jakllsch 	usbd_status	 err;
   1053      1.1  jakllsch 	int		 i;
   1054      1.1  jakllsch 
   1055      1.1  jakllsch 	sc = ifp->if_softc;
   1056      1.1  jakllsch 
   1057      1.1  jakllsch 	ifp->if_timer = 0;
   1058      1.1  jakllsch 	ifp->if_flags &= ~(IFF_RUNNING | IFF_OACTIVE);
   1059      1.1  jakllsch 
   1060      1.1  jakllsch 	if (sc->sc_bulkin_pipe != NULL) {
   1061      1.1  jakllsch 		err = usbd_abort_pipe(sc->sc_bulkin_pipe);
   1062      1.1  jakllsch 		if (err)
   1063      1.1  jakllsch 			printf("%s: abort rx pipe failed: %s\n",
   1064      1.1  jakllsch 			    DEVNAME(sc), usbd_errstr(err));
   1065      1.1  jakllsch 	}
   1066      1.1  jakllsch 
   1067      1.1  jakllsch 	if (sc->sc_bulkout_pipe != NULL) {
   1068      1.1  jakllsch 		err = usbd_abort_pipe(sc->sc_bulkout_pipe);
   1069      1.1  jakllsch 		if (err)
   1070      1.1  jakllsch 			printf("%s: abort tx pipe failed: %s\n",
   1071      1.1  jakllsch 			    DEVNAME(sc), usbd_errstr(err));
   1072      1.1  jakllsch 	}
   1073      1.1  jakllsch 
   1074      1.1  jakllsch 	for (i = 0; i < RNDIS_RX_LIST_CNT; i++) {
   1075      1.1  jakllsch 		if (sc->sc_data.sc_rx_chain[i].sc_mbuf != NULL) {
   1076      1.1  jakllsch 			m_freem(sc->sc_data.sc_rx_chain[i].sc_mbuf);
   1077      1.1  jakllsch 			sc->sc_data.sc_rx_chain[i].sc_mbuf = NULL;
   1078      1.1  jakllsch 		}
   1079      1.1  jakllsch 		if (sc->sc_data.sc_rx_chain[i].sc_xfer != NULL) {
   1080  1.4.2.3  jdolecek 			usbd_destroy_xfer(sc->sc_data.sc_rx_chain[i].sc_xfer);
   1081      1.1  jakllsch 			sc->sc_data.sc_rx_chain[i].sc_xfer = NULL;
   1082      1.1  jakllsch 		}
   1083      1.1  jakllsch 	}
   1084      1.1  jakllsch 
   1085      1.1  jakllsch 	for (i = 0; i < RNDIS_TX_LIST_CNT; i++) {
   1086      1.1  jakllsch 		if (sc->sc_data.sc_tx_chain[i].sc_mbuf != NULL) {
   1087      1.1  jakllsch 			m_freem(sc->sc_data.sc_tx_chain[i].sc_mbuf);
   1088      1.1  jakllsch 			sc->sc_data.sc_tx_chain[i].sc_mbuf = NULL;
   1089      1.1  jakllsch 		}
   1090      1.1  jakllsch 		if (sc->sc_data.sc_tx_chain[i].sc_xfer != NULL) {
   1091  1.4.2.3  jdolecek 			usbd_destroy_xfer(sc->sc_data.sc_tx_chain[i].sc_xfer);
   1092      1.1  jakllsch 			sc->sc_data.sc_tx_chain[i].sc_xfer = NULL;
   1093      1.1  jakllsch 		}
   1094      1.1  jakllsch 	}
   1095  1.4.2.3  jdolecek 
   1096  1.4.2.3  jdolecek 	/* Close pipes. */
   1097  1.4.2.3  jdolecek 	if (sc->sc_bulkin_pipe != NULL) {
   1098  1.4.2.3  jdolecek 		err = usbd_close_pipe(sc->sc_bulkin_pipe);
   1099  1.4.2.3  jdolecek 		if (err)
   1100  1.4.2.3  jdolecek 			printf("%s: close rx pipe failed: %s\n",
   1101  1.4.2.3  jdolecek 			    DEVNAME(sc), usbd_errstr(err));
   1102  1.4.2.3  jdolecek 		sc->sc_bulkin_pipe = NULL;
   1103  1.4.2.3  jdolecek 	}
   1104  1.4.2.3  jdolecek 
   1105  1.4.2.3  jdolecek 	if (sc->sc_bulkout_pipe != NULL) {
   1106  1.4.2.3  jdolecek 		err = usbd_close_pipe(sc->sc_bulkout_pipe);
   1107  1.4.2.3  jdolecek 		if (err)
   1108  1.4.2.3  jdolecek 			printf("%s: close tx pipe failed: %s\n",
   1109  1.4.2.3  jdolecek 			    DEVNAME(sc), usbd_errstr(err));
   1110  1.4.2.3  jdolecek 		sc->sc_bulkout_pipe = NULL;
   1111  1.4.2.3  jdolecek 	}
   1112      1.1  jakllsch }
   1113      1.1  jakllsch 
   1114      1.1  jakllsch static void
   1115      1.1  jakllsch urndis_start(struct ifnet *ifp)
   1116      1.1  jakllsch {
   1117      1.1  jakllsch 	struct urndis_softc	*sc;
   1118      1.1  jakllsch 	struct mbuf		*m_head = NULL;
   1119      1.1  jakllsch 
   1120      1.1  jakllsch 	sc = ifp->if_softc;
   1121      1.1  jakllsch 
   1122      1.1  jakllsch 	if (sc->sc_dying || (ifp->if_flags & IFF_OACTIVE))
   1123      1.1  jakllsch 		return;
   1124      1.1  jakllsch 
   1125      1.1  jakllsch 	IFQ_POLL(&ifp->if_snd, m_head);
   1126      1.1  jakllsch 	if (m_head == NULL)
   1127      1.1  jakllsch 		return;
   1128      1.1  jakllsch 
   1129      1.1  jakllsch 	if (urndis_encap(sc, m_head, 0)) {
   1130      1.1  jakllsch 		ifp->if_flags |= IFF_OACTIVE;
   1131      1.1  jakllsch 		return;
   1132      1.1  jakllsch 	}
   1133      1.1  jakllsch 	IFQ_DEQUEUE(&ifp->if_snd, m_head);
   1134      1.1  jakllsch 
   1135      1.1  jakllsch 	/*
   1136      1.1  jakllsch 	 * If there's a BPF listener, bounce a copy of this frame
   1137      1.1  jakllsch 	 * to him.
   1138      1.1  jakllsch 	 */
   1139      1.1  jakllsch 	bpf_mtap(ifp, m_head);
   1140      1.1  jakllsch 
   1141      1.1  jakllsch 	ifp->if_flags |= IFF_OACTIVE;
   1142      1.1  jakllsch 
   1143      1.1  jakllsch 	/*
   1144      1.1  jakllsch 	 * Set a timeout in case the chip goes out to lunch.
   1145      1.1  jakllsch 	 */
   1146      1.1  jakllsch 	ifp->if_timer = 5;
   1147      1.1  jakllsch 
   1148      1.1  jakllsch 	return;
   1149      1.1  jakllsch }
   1150      1.1  jakllsch 
   1151      1.1  jakllsch static void
   1152  1.4.2.3  jdolecek urndis_rxeof(struct usbd_xfer *xfer,
   1153  1.4.2.3  jdolecek     void *priv,
   1154      1.1  jakllsch     usbd_status status)
   1155      1.1  jakllsch {
   1156      1.1  jakllsch 	struct urndis_chain	*c;
   1157      1.1  jakllsch 	struct urndis_softc	*sc;
   1158      1.1  jakllsch 	struct ifnet		*ifp;
   1159      1.1  jakllsch 	uint32_t		 total_len;
   1160      1.1  jakllsch 
   1161      1.1  jakllsch 	c = priv;
   1162      1.1  jakllsch 	sc = c->sc_softc;
   1163      1.1  jakllsch 	ifp = GET_IFP(sc);
   1164      1.1  jakllsch 	total_len = 0;
   1165      1.1  jakllsch 
   1166      1.1  jakllsch 	if (sc->sc_dying || !(ifp->if_flags & IFF_RUNNING))
   1167      1.1  jakllsch 		return;
   1168      1.1  jakllsch 
   1169      1.1  jakllsch 	if (status != USBD_NORMAL_COMPLETION) {
   1170      1.1  jakllsch 		if (status == USBD_NOT_STARTED || status == USBD_CANCELLED)
   1171      1.1  jakllsch 			return;
   1172      1.1  jakllsch 		if (usbd_ratecheck(&sc->sc_rx_notice)) {
   1173      1.1  jakllsch 			printf("%s: usb errors on rx: %s\n",
   1174      1.1  jakllsch 			    DEVNAME(sc), usbd_errstr(status));
   1175      1.1  jakllsch 		}
   1176      1.1  jakllsch 		if (status == USBD_STALLED)
   1177      1.1  jakllsch 			usbd_clear_endpoint_stall_async(sc->sc_bulkin_pipe);
   1178      1.1  jakllsch 
   1179      1.1  jakllsch 		goto done;
   1180      1.1  jakllsch 	}
   1181      1.1  jakllsch 
   1182      1.1  jakllsch 	usbd_get_xfer_status(xfer, NULL, NULL, &total_len, NULL);
   1183      1.1  jakllsch 	urndis_decap(sc, c, total_len);
   1184      1.1  jakllsch 
   1185      1.1  jakllsch done:
   1186      1.1  jakllsch 	/* Setup new transfer. */
   1187  1.4.2.3  jdolecek 	usbd_setup_xfer(c->sc_xfer, c, c->sc_buf, RNDIS_BUFSZ,
   1188  1.4.2.3  jdolecek 	    USBD_SHORT_XFER_OK, USBD_NO_TIMEOUT, urndis_rxeof);
   1189      1.1  jakllsch 	usbd_transfer(c->sc_xfer);
   1190      1.1  jakllsch }
   1191      1.1  jakllsch 
   1192      1.1  jakllsch static void
   1193  1.4.2.3  jdolecek urndis_txeof(struct usbd_xfer *xfer,
   1194  1.4.2.3  jdolecek     void *priv,
   1195      1.1  jakllsch     usbd_status status)
   1196      1.1  jakllsch {
   1197      1.1  jakllsch 	struct urndis_chain	*c;
   1198      1.1  jakllsch 	struct urndis_softc	*sc;
   1199      1.1  jakllsch 	struct ifnet		*ifp;
   1200      1.1  jakllsch 	usbd_status		 err;
   1201      1.1  jakllsch 	int			 s;
   1202      1.1  jakllsch 
   1203      1.1  jakllsch 	c = priv;
   1204      1.1  jakllsch 	sc = c->sc_softc;
   1205      1.1  jakllsch 	ifp = GET_IFP(sc);
   1206      1.1  jakllsch 
   1207      1.1  jakllsch 	DPRINTF(("%s: urndis_txeof\n", DEVNAME(sc)));
   1208      1.1  jakllsch 
   1209      1.1  jakllsch 	if (sc->sc_dying)
   1210      1.1  jakllsch 		return;
   1211      1.1  jakllsch 
   1212      1.1  jakllsch 	s = splnet();
   1213      1.1  jakllsch 
   1214      1.1  jakllsch 	ifp->if_timer = 0;
   1215      1.1  jakllsch 	ifp->if_flags &= ~IFF_OACTIVE;
   1216      1.1  jakllsch 
   1217      1.1  jakllsch 	if (status != USBD_NORMAL_COMPLETION) {
   1218      1.1  jakllsch 		if (status == USBD_NOT_STARTED || status == USBD_CANCELLED) {
   1219      1.1  jakllsch 			splx(s);
   1220      1.1  jakllsch 			return;
   1221      1.1  jakllsch 		}
   1222      1.1  jakllsch 		ifp->if_oerrors++;
   1223      1.1  jakllsch 		printf("%s: usb error on tx: %s\n", DEVNAME(sc),
   1224      1.1  jakllsch 		    usbd_errstr(status));
   1225      1.1  jakllsch 		if (status == USBD_STALLED)
   1226      1.1  jakllsch 			usbd_clear_endpoint_stall_async(sc->sc_bulkout_pipe);
   1227      1.1  jakllsch 		splx(s);
   1228      1.1  jakllsch 		return;
   1229      1.1  jakllsch 	}
   1230      1.1  jakllsch 
   1231      1.1  jakllsch 	usbd_get_xfer_status(c->sc_xfer, NULL, NULL, NULL, &err);
   1232      1.1  jakllsch 
   1233      1.1  jakllsch 	if (c->sc_mbuf != NULL) {
   1234      1.1  jakllsch 		m_freem(c->sc_mbuf);
   1235      1.1  jakllsch 		c->sc_mbuf = NULL;
   1236      1.1  jakllsch 	}
   1237      1.1  jakllsch 
   1238      1.1  jakllsch 	if (err)
   1239      1.1  jakllsch 		ifp->if_oerrors++;
   1240      1.1  jakllsch 	else
   1241      1.1  jakllsch 		ifp->if_opackets++;
   1242      1.1  jakllsch 
   1243      1.1  jakllsch 	if (IFQ_IS_EMPTY(&ifp->if_snd) == 0)
   1244      1.1  jakllsch 		urndis_start(ifp);
   1245      1.1  jakllsch 
   1246      1.1  jakllsch 	splx(s);
   1247      1.1  jakllsch }
   1248      1.1  jakllsch 
   1249      1.1  jakllsch static int
   1250      1.1  jakllsch urndis_match(device_t parent, cfdata_t match, void *aux)
   1251      1.1  jakllsch {
   1252  1.4.2.3  jdolecek 	struct usbif_attach_arg		*uiaa = aux;
   1253      1.1  jakllsch 	usb_interface_descriptor_t	*id;
   1254      1.1  jakllsch 
   1255  1.4.2.3  jdolecek 	if (!uiaa->uiaa_iface)
   1256  1.4.2.3  jdolecek 		return UMATCH_NONE;
   1257      1.1  jakllsch 
   1258  1.4.2.3  jdolecek 	id = usbd_get_interface_descriptor(uiaa->uiaa_iface);
   1259      1.1  jakllsch 	if (id == NULL)
   1260  1.4.2.3  jdolecek 		return UMATCH_NONE;
   1261      1.1  jakllsch 
   1262      1.1  jakllsch 	if (id->bInterfaceClass == UICLASS_WIRELESS &&
   1263      1.1  jakllsch 	    id->bInterfaceSubClass == UISUBCLASS_RF &&
   1264      1.1  jakllsch 	    id->bInterfaceProtocol == UIPROTO_RNDIS)
   1265  1.4.2.3  jdolecek 		return UMATCH_IFACECLASS_IFACESUBCLASS_IFACEPROTO;
   1266      1.1  jakllsch 
   1267  1.4.2.3  jdolecek 	return usb_lookup(urndis_devs, uiaa->uiaa_vendor, uiaa->uiaa_product) != NULL ?
   1268      1.1  jakllsch 	    UMATCH_VENDOR_PRODUCT : UMATCH_NONE;
   1269      1.1  jakllsch }
   1270      1.1  jakllsch 
   1271      1.1  jakllsch static void
   1272      1.1  jakllsch urndis_attach(device_t parent, device_t self, void *aux)
   1273      1.1  jakllsch {
   1274      1.1  jakllsch 	struct urndis_softc		*sc;
   1275  1.4.2.3  jdolecek 	struct usbif_attach_arg		*uiaa;
   1276      1.1  jakllsch 	struct ifnet			*ifp;
   1277      1.1  jakllsch 	usb_interface_descriptor_t	*id;
   1278      1.1  jakllsch 	usb_endpoint_descriptor_t	*ed;
   1279      1.1  jakllsch 	usb_config_descriptor_t		*cd;
   1280      1.1  jakllsch 	const usb_cdc_union_descriptor_t *ud;
   1281      1.1  jakllsch 	const usb_cdc_header_descriptor_t *desc;
   1282      1.1  jakllsch 	usbd_desc_iter_t		 iter;
   1283      1.1  jakllsch 	int				 if_ctl, if_data;
   1284      1.1  jakllsch 	int				 i, j, altcnt;
   1285      1.1  jakllsch 	int				 s;
   1286      1.1  jakllsch 	u_char				 eaddr[ETHER_ADDR_LEN];
   1287      1.1  jakllsch 	void				*buf;
   1288      1.1  jakllsch 	size_t				 bufsz;
   1289      1.1  jakllsch 	uint32_t			 filter;
   1290      1.1  jakllsch 	char				*devinfop;
   1291      1.1  jakllsch 
   1292      1.1  jakllsch 	sc = device_private(self);
   1293  1.4.2.3  jdolecek 	uiaa = aux;
   1294      1.1  jakllsch 	sc->sc_dev = self;
   1295  1.4.2.3  jdolecek 	sc->sc_udev = uiaa->uiaa_device;
   1296      1.1  jakllsch 
   1297      1.1  jakllsch 	aprint_naive("\n");
   1298      1.1  jakllsch 	aprint_normal("\n");
   1299      1.1  jakllsch 
   1300  1.4.2.3  jdolecek 	devinfop = usbd_devinfo_alloc(uiaa->uiaa_device, 0);
   1301      1.1  jakllsch 	aprint_normal_dev(self, "%s\n", devinfop);
   1302      1.1  jakllsch 	usbd_devinfo_free(devinfop);
   1303      1.1  jakllsch 
   1304  1.4.2.3  jdolecek 	sc->sc_iface_ctl = uiaa->uiaa_iface;
   1305      1.1  jakllsch 	id = usbd_get_interface_descriptor(sc->sc_iface_ctl);
   1306      1.1  jakllsch 	if_ctl = id->bInterfaceNumber;
   1307      1.1  jakllsch 	sc->sc_ifaceno_ctl = if_ctl;
   1308      1.1  jakllsch 	if_data = -1;
   1309      1.1  jakllsch 
   1310      1.1  jakllsch 	usb_desc_iter_init(sc->sc_udev, &iter);
   1311      1.1  jakllsch 	while ((desc = (const void *)usb_desc_iter_next(&iter)) != NULL) {
   1312      1.1  jakllsch 
   1313      1.1  jakllsch 		if (desc->bDescriptorType != UDESC_CS_INTERFACE) {
   1314      1.1  jakllsch 			continue;
   1315      1.1  jakllsch 		}
   1316      1.1  jakllsch 		switch (desc->bDescriptorSubtype) {
   1317      1.1  jakllsch 		case UDESCSUB_CDC_UNION:
   1318      1.1  jakllsch 			/* XXX bail out when found first? */
   1319      1.1  jakllsch 			ud = (const usb_cdc_union_descriptor_t *)desc;
   1320      1.1  jakllsch 			if (if_data == -1)
   1321      1.1  jakllsch 				if_data = ud->bSlaveInterface[0];
   1322      1.1  jakllsch 			break;
   1323      1.1  jakllsch 		}
   1324      1.1  jakllsch 	}
   1325      1.1  jakllsch 
   1326      1.1  jakllsch 	if (if_data == -1) {
   1327      1.1  jakllsch 		DPRINTF(("urndis_attach: no union interface\n"));
   1328      1.1  jakllsch 		sc->sc_iface_data = sc->sc_iface_ctl;
   1329      1.1  jakllsch 	} else {
   1330      1.1  jakllsch 		DPRINTF(("urndis_attach: union interface: ctl %u, data %u\n",
   1331      1.1  jakllsch 		    if_ctl, if_data));
   1332  1.4.2.3  jdolecek 		for (i = 0; i < uiaa->uiaa_nifaces; i++) {
   1333  1.4.2.3  jdolecek 			if (uiaa->uiaa_ifaces[i] != NULL) {
   1334      1.1  jakllsch 				id = usbd_get_interface_descriptor(
   1335  1.4.2.3  jdolecek 				    uiaa->uiaa_ifaces[i]);
   1336      1.1  jakllsch 				if (id != NULL && id->bInterfaceNumber ==
   1337      1.1  jakllsch 				    if_data) {
   1338  1.4.2.3  jdolecek 					sc->sc_iface_data = uiaa->uiaa_ifaces[i];
   1339  1.4.2.3  jdolecek 					uiaa->uiaa_ifaces[i] = NULL;
   1340      1.1  jakllsch 				}
   1341      1.1  jakllsch 			}
   1342      1.1  jakllsch 		}
   1343      1.1  jakllsch 	}
   1344      1.1  jakllsch 
   1345      1.1  jakllsch 	if (sc->sc_iface_data == NULL) {
   1346  1.4.2.3  jdolecek 		aprint_error("%s: no data interface\n", DEVNAME(sc));
   1347      1.1  jakllsch 		return;
   1348      1.1  jakllsch 	}
   1349      1.1  jakllsch 
   1350      1.1  jakllsch 	id = usbd_get_interface_descriptor(sc->sc_iface_data);
   1351      1.1  jakllsch 	cd = usbd_get_config_descriptor(sc->sc_udev);
   1352      1.1  jakllsch 	altcnt = usbd_get_no_alts(cd, id->bInterfaceNumber);
   1353      1.1  jakllsch 
   1354      1.1  jakllsch 	for (j = 0; j < altcnt; j++) {
   1355      1.1  jakllsch 		if (usbd_set_interface(sc->sc_iface_data, j)) {
   1356  1.4.2.3  jdolecek 			aprint_error("%s: interface alternate setting %u "
   1357  1.4.2.3  jdolecek 			    "failed\n", DEVNAME(sc), j);
   1358      1.1  jakllsch 			return;
   1359      1.1  jakllsch 		}
   1360      1.1  jakllsch 		/* Find endpoints. */
   1361      1.1  jakllsch 		id = usbd_get_interface_descriptor(sc->sc_iface_data);
   1362      1.1  jakllsch 		sc->sc_bulkin_no = sc->sc_bulkout_no = -1;
   1363      1.1  jakllsch 		for (i = 0; i < id->bNumEndpoints; i++) {
   1364      1.1  jakllsch 			ed = usbd_interface2endpoint_descriptor(
   1365      1.1  jakllsch 			    sc->sc_iface_data, i);
   1366      1.1  jakllsch 			if (!ed) {
   1367  1.4.2.3  jdolecek 				aprint_error("%s: no descriptor for bulk "
   1368  1.4.2.3  jdolecek 				    "endpoint %u\n", DEVNAME(sc), i);
   1369      1.1  jakllsch 				return;
   1370      1.1  jakllsch 			}
   1371      1.1  jakllsch 			if (UE_GET_DIR(ed->bEndpointAddress) == UE_DIR_IN &&
   1372      1.1  jakllsch 			    UE_GET_XFERTYPE(ed->bmAttributes) == UE_BULK) {
   1373      1.1  jakllsch 				sc->sc_bulkin_no = ed->bEndpointAddress;
   1374      1.1  jakllsch 			}
   1375      1.1  jakllsch 			else if (
   1376      1.1  jakllsch 			    UE_GET_DIR(ed->bEndpointAddress) == UE_DIR_OUT &&
   1377      1.1  jakllsch 			    UE_GET_XFERTYPE(ed->bmAttributes) == UE_BULK) {
   1378      1.1  jakllsch 				sc->sc_bulkout_no = ed->bEndpointAddress;
   1379      1.1  jakllsch 			}
   1380      1.1  jakllsch 		}
   1381      1.1  jakllsch 
   1382      1.1  jakllsch 		if (sc->sc_bulkin_no != -1 && sc->sc_bulkout_no != -1) {
   1383      1.1  jakllsch 			DPRINTF(("%s: in=0x%x, out=0x%x\n",
   1384      1.1  jakllsch 			    DEVNAME(sc),
   1385      1.1  jakllsch 			    sc->sc_bulkin_no,
   1386      1.1  jakllsch 			    sc->sc_bulkout_no));
   1387      1.1  jakllsch 			goto found;
   1388      1.1  jakllsch 		}
   1389      1.1  jakllsch 	}
   1390      1.1  jakllsch 
   1391      1.1  jakllsch 	if (sc->sc_bulkin_no == -1)
   1392  1.4.2.3  jdolecek 		aprint_error("%s: could not find data bulk in\n", DEVNAME(sc));
   1393      1.1  jakllsch 	if (sc->sc_bulkout_no == -1 )
   1394  1.4.2.3  jdolecek 		aprint_error("%s: could not find data bulk out\n",DEVNAME(sc));
   1395      1.1  jakllsch 	return;
   1396      1.1  jakllsch 
   1397      1.1  jakllsch 	found:
   1398      1.1  jakllsch 
   1399      1.1  jakllsch 	ifp = GET_IFP(sc);
   1400      1.1  jakllsch 	ifp->if_softc = sc;
   1401      1.1  jakllsch 	ifp->if_flags = IFF_BROADCAST | IFF_SIMPLEX | IFF_MULTICAST;
   1402      1.1  jakllsch 	ifp->if_start = urndis_start;
   1403      1.1  jakllsch 	ifp->if_ioctl = urndis_ioctl;
   1404  1.4.2.2       tls 	ifp->if_init = urndis_init;
   1405      1.1  jakllsch #if 0
   1406      1.1  jakllsch 	ifp->if_watchdog = urndis_watchdog;
   1407      1.1  jakllsch #endif
   1408      1.1  jakllsch 
   1409      1.1  jakllsch 	strlcpy(ifp->if_xname, DEVNAME(sc), IFNAMSIZ);
   1410      1.1  jakllsch 
   1411      1.1  jakllsch 	IFQ_SET_READY(&ifp->if_snd);
   1412      1.1  jakllsch 
   1413      1.1  jakllsch 	urndis_init(ifp);
   1414      1.1  jakllsch 
   1415      1.1  jakllsch 	s = splnet();
   1416      1.1  jakllsch 
   1417      1.1  jakllsch 	if (urndis_ctrl_query(sc, OID_802_3_PERMANENT_ADDRESS, NULL, 0,
   1418      1.1  jakllsch 	    &buf, &bufsz) != RNDIS_STATUS_SUCCESS) {
   1419  1.4.2.3  jdolecek 		aprint_error("%s: unable to get hardware address\n",
   1420  1.4.2.3  jdolecek 		    DEVNAME(sc));
   1421      1.1  jakllsch 		urndis_stop(ifp);
   1422      1.1  jakllsch 		splx(s);
   1423      1.1  jakllsch 		return;
   1424      1.1  jakllsch 	}
   1425      1.1  jakllsch 
   1426      1.1  jakllsch 	if (bufsz == ETHER_ADDR_LEN) {
   1427      1.1  jakllsch 		memcpy(eaddr, buf, ETHER_ADDR_LEN);
   1428  1.4.2.3  jdolecek 		aprint_normal("%s: address %s\n", DEVNAME(sc),
   1429  1.4.2.3  jdolecek 		    ether_sprintf(eaddr));
   1430      1.1  jakllsch 		kmem_free(buf, bufsz);
   1431      1.1  jakllsch 	} else {
   1432  1.4.2.3  jdolecek 		aprint_error("%s: invalid address\n", DEVNAME(sc));
   1433      1.1  jakllsch 		kmem_free(buf, bufsz);
   1434      1.1  jakllsch 		urndis_stop(ifp);
   1435      1.1  jakllsch 		splx(s);
   1436      1.1  jakllsch 		return;
   1437      1.1  jakllsch 	}
   1438      1.1  jakllsch 
   1439      1.1  jakllsch 	/* Initialize packet filter */
   1440  1.4.2.1       tls 	sc->sc_filter = RNDIS_PACKET_TYPE_BROADCAST;
   1441      1.1  jakllsch 	sc->sc_filter |= RNDIS_PACKET_TYPE_ALL_MULTICAST;
   1442      1.1  jakllsch 	filter = htole32(sc->sc_filter);
   1443      1.1  jakllsch 	if (urndis_ctrl_set(sc, OID_GEN_CURRENT_PACKET_FILTER, &filter,
   1444      1.1  jakllsch 	    sizeof(filter)) != RNDIS_STATUS_SUCCESS) {
   1445  1.4.2.3  jdolecek 		aprint_error("%s: unable to set data filters\n", DEVNAME(sc));
   1446      1.1  jakllsch 		urndis_stop(ifp);
   1447      1.1  jakllsch 		splx(s);
   1448      1.1  jakllsch 		return;
   1449      1.1  jakllsch 	}
   1450      1.1  jakllsch 
   1451      1.1  jakllsch 	if_attach(ifp);
   1452      1.1  jakllsch 	ether_ifattach(ifp, eaddr);
   1453      1.1  jakllsch 	sc->sc_attached = 1;
   1454      1.1  jakllsch 
   1455      1.1  jakllsch 	splx(s);
   1456      1.1  jakllsch }
   1457      1.1  jakllsch 
   1458      1.1  jakllsch static int
   1459      1.1  jakllsch urndis_detach(device_t self, int flags)
   1460      1.1  jakllsch {
   1461      1.1  jakllsch 	struct urndis_softc	*sc;
   1462      1.1  jakllsch 	struct ifnet		*ifp;
   1463      1.1  jakllsch 	int			 s;
   1464      1.1  jakllsch 
   1465      1.1  jakllsch 	sc = device_private(self);
   1466      1.1  jakllsch 
   1467      1.1  jakllsch 	DPRINTF(("urndis_detach: %s flags %u\n", DEVNAME(sc),
   1468      1.1  jakllsch 	    flags));
   1469  1.4.2.1       tls 
   1470      1.1  jakllsch 	if (!sc->sc_attached)
   1471      1.1  jakllsch 		return 0;
   1472      1.1  jakllsch 
   1473      1.1  jakllsch 	s = splusb();
   1474      1.1  jakllsch 
   1475      1.1  jakllsch 	ifp = GET_IFP(sc);
   1476      1.1  jakllsch 
   1477      1.1  jakllsch 	if (ifp->if_softc != NULL) {
   1478      1.1  jakllsch 		ether_ifdetach(ifp);
   1479      1.1  jakllsch 		if_detach(ifp);
   1480      1.1  jakllsch 	}
   1481      1.1  jakllsch 
   1482      1.1  jakllsch 	urndis_stop(ifp);
   1483      1.1  jakllsch 	sc->sc_attached = 0;
   1484      1.1  jakllsch 
   1485      1.1  jakllsch 	splx(s);
   1486      1.1  jakllsch 
   1487      1.1  jakllsch 	return 0;
   1488      1.1  jakllsch }
   1489      1.1  jakllsch 
   1490      1.1  jakllsch static int
   1491      1.1  jakllsch urndis_activate(device_t self, enum devact act)
   1492      1.1  jakllsch {
   1493      1.1  jakllsch 	struct urndis_softc *sc;
   1494      1.1  jakllsch 
   1495      1.1  jakllsch 	sc = device_private(self);
   1496      1.1  jakllsch 
   1497      1.1  jakllsch 	switch (act) {
   1498      1.1  jakllsch 	case DVACT_DEACTIVATE:
   1499      1.1  jakllsch 		sc->sc_dying = 1;
   1500      1.1  jakllsch 		return 0;
   1501      1.1  jakllsch 	}
   1502      1.1  jakllsch 
   1503      1.1  jakllsch 	return EOPNOTSUPP;
   1504      1.1  jakllsch }
   1505