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