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