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