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