svn commit: r261541 - in head/sys: conf dev/usb dev/usb/net modules/usb modules/usb/urndis
Hans Petter Selasky
hselasky at FreeBSD.org
Thu Feb 6 08:47:15 UTC 2014
Author: hselasky
Date: Thu Feb 6 08:47:14 2014
New Revision: 261541
URL: http://svnweb.freebsd.org/changeset/base/261541
Log:
Import USB RNDIS driver to FreeBSD from OpenBSD.
Useful for so-called USB tethering.
- Imported code from OpenBSD
- Adapted code to FreeBSD
- Removed some unused functions
- Fixed some buffer encoding and decoding issues
- Optimised data transport path a bit, by sending multiple packets at a time
- Increased receive buffer to 16K
Obtained from: OpenBSD
Requested by: eadler @
MFC after: 2 weeks
Added:
head/sys/dev/usb/net/if_urndis.c (contents, props changed)
head/sys/dev/usb/net/if_urndisreg.h (contents, props changed)
head/sys/modules/usb/urndis/
head/sys/modules/usb/urndis/Makefile (contents, props changed)
Modified:
head/sys/conf/NOTES
head/sys/conf/files
head/sys/dev/usb/usb.h
head/sys/modules/usb/Makefile
Modified: head/sys/conf/NOTES
==============================================================================
--- head/sys/conf/NOTES Thu Feb 6 07:59:05 2014 (r261540)
+++ head/sys/conf/NOTES Thu Feb 6 08:47:14 2014 (r261541)
@@ -2746,6 +2746,8 @@ device upgt
# Ralink Technology RT2500USB wireless driver
device ural
#
+# RNDIS USB ethernet driver
+device urndis
# Realtek RTL8187B/L wireless driver
device urtw
#
Modified: head/sys/conf/files
==============================================================================
--- head/sys/conf/files Thu Feb 6 07:59:05 2014 (r261540)
+++ head/sys/conf/files Thu Feb 6 08:47:14 2014 (r261541)
@@ -2293,9 +2293,11 @@ dev/usb/net/if_rue.c optional rue
dev/usb/net/if_smsc.c optional smsc
dev/usb/net/if_udav.c optional udav
dev/usb/net/if_usie.c optional usie
+dev/usb/net/if_urndis.c optional urndis
dev/usb/net/ruephy.c optional rue
dev/usb/net/usb_ethernet.c optional aue | axe | axge | cdce | cue | kue | \
- mos | rue | smsc | udav | ipheth
+ mos | rue | smsc | udav | ipheth | \
+ urndis
dev/usb/net/uhso.c optional uhso
#
# USB WLAN drivers
Added: head/sys/dev/usb/net/if_urndis.c
==============================================================================
--- /dev/null 00:00:00 1970 (empty, because file is newly added)
+++ head/sys/dev/usb/net/if_urndis.c Thu Feb 6 08:47:14 2014 (r261541)
@@ -0,0 +1,1013 @@
+/* $OpenBSD: if_urndis.c,v 1.46 2013/12/09 15:45:29 pirofti Exp $ */
+
+/*
+ * Copyright (c) 2010 Jonathan Armani <armani at openbsd.org>
+ * Copyright (c) 2010 Fabien Romano <fabien at openbsd.org>
+ * Copyright (c) 2010 Michael Knudsen <mk at openbsd.org>
+ * Copyright (c) 2014 Hans Petter Selasky <hselasky at freebsd.org>
+ * All rights reserved.
+ *
+ * Permission to use, copy, modify, and distribute this software for any
+ * purpose with or without fee is hereby granted, provided that the above
+ * copyright notice and this permission notice appear in all copies.
+ *
+ * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
+ * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
+ * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
+ * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
+ * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
+ * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
+ * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
+ */
+
+#include <sys/cdefs.h>
+__FBSDID("$FreeBSD$");
+
+#include <sys/stdint.h>
+#include <sys/stddef.h>
+#include <sys/param.h>
+#include <sys/queue.h>
+#include <sys/types.h>
+#include <sys/systm.h>
+#include <sys/socket.h>
+#include <sys/kernel.h>
+#include <sys/bus.h>
+#include <sys/module.h>
+#include <sys/lock.h>
+#include <sys/mutex.h>
+#include <sys/condvar.h>
+#include <sys/sysctl.h>
+#include <sys/sx.h>
+#include <sys/unistd.h>
+#include <sys/callout.h>
+#include <sys/malloc.h>
+#include <sys/priv.h>
+
+#include <net/if.h>
+#include <net/if_var.h>
+
+#include <dev/usb/usb.h>
+#include <dev/usb/usbdi.h>
+#include <dev/usb/usbdi_util.h>
+#include "usbdevs.h"
+
+#define USB_DEBUG_VAR urndis_debug
+#include <dev/usb/usb_debug.h>
+#include <dev/usb/usb_process.h>
+#include "usb_if.h"
+
+#include <dev/usb/net/usb_ethernet.h>
+#include <dev/usb/net/if_urndisreg.h>
+
+#include <dev/usb/usb_cdc.h>
+
+static device_probe_t urndis_probe;
+static device_attach_t urndis_attach;
+static device_detach_t urndis_detach;
+static device_suspend_t urndis_suspend;
+static device_resume_t urndis_resume;
+
+static usb_callback_t urndis_bulk_write_callback;
+static usb_callback_t urndis_bulk_read_callback;
+static usb_callback_t urndis_intr_read_callback;
+
+static uether_fn_t urndis_attach_post;
+static uether_fn_t urndis_init;
+static uether_fn_t urndis_stop;
+static uether_fn_t urndis_start;
+static uether_fn_t urndis_setmulti;
+static uether_fn_t urndis_setpromisc;
+
+static uint32_t urndis_ctrl_query(struct urndis_softc *, uint32_t, const void **, uint16_t *);
+static uint32_t urndis_ctrl_set(struct urndis_softc *, uint32_t, struct urndis_set_req *, uint16_t);
+static uint32_t urndis_ctrl_handle_init(struct urndis_softc *, const struct urndis_comp_hdr *);
+static uint32_t urndis_ctrl_handle_query(struct urndis_softc *, const struct urndis_comp_hdr *, const void **, uint16_t *);
+static uint32_t urndis_ctrl_handle_reset(struct urndis_softc *, const struct urndis_comp_hdr *);
+static uint32_t urndis_ctrl_init(struct urndis_softc *);
+
+#ifdef USB_DEBUG
+static int urndis_debug = 0;
+static SYSCTL_NODE(_hw_usb, OID_AUTO, urndis, CTLFLAG_RW, 0, "USB RNDIS-Ethernet");
+SYSCTL_INT(_hw_usb_urndis, OID_AUTO, debug, CTLFLAG_RW, &urndis_debug, 0,
+ "Debug level");
+#endif
+
+static const struct usb_config urndis_config[URNDIS_N_TRANSFER] = {
+
+ [URNDIS_BULK_RX] = {
+ .type = UE_BULK,
+ .endpoint = UE_ADDR_ANY,
+ .direction = UE_DIR_RX,
+ .if_index = 0,
+ .frames = 1,
+ .bufsize = RNDIS_RX_MAXLEN,
+ .flags = {.short_xfer_ok = 1,},
+ .callback = urndis_bulk_read_callback,
+ .timeout = 0, /* no timeout */
+ .usb_mode = USB_MODE_HOST,
+ },
+
+ [URNDIS_BULK_TX] = {
+ .type = UE_BULK,
+ .endpoint = UE_ADDR_ANY,
+ .direction = UE_DIR_TX,
+ .if_index = 0,
+ .frames = RNDIS_TX_FRAMES_MAX,
+ .bufsize = (RNDIS_TX_FRAMES_MAX * RNDIS_TX_MAXLEN),
+ .flags = {
+ .force_short_xfer = 1,
+ },
+ .callback = urndis_bulk_write_callback,
+ .timeout = 10000, /* 10 seconds */
+ .usb_mode = USB_MODE_HOST,
+ },
+
+ [URNDIS_INTR_RX] = {
+ .type = UE_INTERRUPT,
+ .endpoint = UE_ADDR_ANY,
+ .direction = UE_DIR_RX,
+ .if_index = 1,
+ .bufsize = 0, /* use wMaxPacketSize */
+ .flags = {.short_xfer_ok = 1,.no_pipe_ok = 1,},
+ .callback = urndis_intr_read_callback,
+ .timeout = 0,
+ .usb_mode = USB_MODE_HOST,
+ },
+};
+
+static device_method_t urndis_methods[] = {
+ /* Device interface */
+ DEVMETHOD(device_probe, urndis_probe),
+ DEVMETHOD(device_attach, urndis_attach),
+ DEVMETHOD(device_detach, urndis_detach),
+ DEVMETHOD(device_suspend, urndis_suspend),
+ DEVMETHOD(device_resume, urndis_resume),
+
+ DEVMETHOD_END
+};
+
+static driver_t urndis_driver = {
+ .name = "urndis",
+ .methods = urndis_methods,
+ .size = sizeof(struct urndis_softc),
+};
+
+static devclass_t urndis_devclass;
+
+DRIVER_MODULE(urndis, uhub, urndis_driver, urndis_devclass, NULL, 0);
+MODULE_VERSION(urndis, 1);
+MODULE_DEPEND(urndis, uether, 1, 1, 1);
+MODULE_DEPEND(urndis, usb, 1, 1, 1);
+MODULE_DEPEND(urndis, ether, 1, 1, 1);
+
+static const struct usb_ether_methods urndis_ue_methods = {
+ .ue_attach_post = urndis_attach_post,
+ .ue_start = urndis_start,
+ .ue_init = urndis_init,
+ .ue_stop = urndis_stop,
+ .ue_setmulti = urndis_setmulti,
+ .ue_setpromisc = urndis_setpromisc,
+};
+
+static const STRUCT_USB_HOST_ID urndis_host_devs[] = {
+ {USB_IFACE_CLASS(UICLASS_CDC), USB_IFACE_SUBCLASS(UISUBCLASS_ABSTRACT_CONTROL_MODEL),
+ USB_IFACE_PROTOCOL(0xff)},
+ {USB_IFACE_CLASS(UICLASS_WIRELESS), USB_IFACE_SUBCLASS(UISUBCLASS_RF),
+ USB_IFACE_PROTOCOL(UIPROTO_RNDIS)},
+ {USB_IFACE_CLASS(UICLASS_IAD), USB_IFACE_SUBCLASS(UISUBCLASS_SYNC),
+ USB_IFACE_PROTOCOL(UIPROTO_ACTIVESYNC)},
+};
+
+static int
+urndis_probe(device_t dev)
+{
+ struct usb_attach_arg *uaa = device_get_ivars(dev);
+
+ return (usbd_lookup_id_by_uaa(urndis_host_devs, sizeof(urndis_host_devs), uaa));
+}
+
+static void
+urndis_attach_post(struct usb_ether *ue)
+{
+ /* no-op */
+ return;
+}
+
+static int
+urndis_attach(device_t dev)
+{
+ struct urndis_softc *sc = device_get_softc(dev);
+ struct usb_ether *ue = &sc->sc_ue;
+ struct usb_attach_arg *uaa = device_get_ivars(dev);
+ struct usb_cdc_cm_descriptor *cmd;
+ struct {
+ struct urndis_set_req hdr;
+ uint32_t filter;
+ } msg_filter;
+ const void *buf;
+ uint16_t bufsz;
+ uint8_t iface_index[2] = { uaa->info.bIfaceIndex + 1, uaa->info.bIfaceIndex };
+ int error;
+ uint8_t i;
+
+ sc->sc_ue.ue_udev = uaa->device;
+ sc->sc_ifaceno_ctl = uaa->info.bIfaceNum;
+
+ cmd = usbd_find_descriptor(uaa->device, NULL, uaa->info.bIfaceIndex,
+ UDESC_CS_INTERFACE, 0xFF, UDESCSUB_CDC_CM, 0xFF);
+ if (cmd != 0) {
+ DPRINTF("Call Mode Descriptor found, dataif=%d\n", cmd->bDataInterface);
+ iface_index[0] = cmd->bDataInterface;
+ }
+
+ device_set_usb_desc(dev);
+
+ mtx_init(&sc->sc_mtx, device_get_nameunit(dev), NULL, MTX_DEF);
+
+ /* scan the alternate settings looking for a valid one */
+
+ for (i = 0; i != 32; i++) {
+
+ error = usbd_set_alt_interface_index(uaa->device,
+ iface_index[0], i);
+
+ if (error != 0)
+ break;
+
+ error = usbd_transfer_setup(uaa->device,
+ iface_index, sc->sc_xfer, urndis_config,
+ URNDIS_N_TRANSFER, sc, &sc->sc_mtx);
+
+ if (error == 0)
+ break;
+ }
+
+ if ((error != 0) || (i == 32)) {
+ device_printf(dev, "No valid alternate "
+ "setting found\n");
+ goto detach;
+ }
+ URNDIS_LOCK(sc);
+ error = urndis_ctrl_query(sc, OID_802_3_PERMANENT_ADDRESS, &buf, &bufsz);
+ URNDIS_UNLOCK(sc);
+
+ if (error != (int)RNDIS_STATUS_SUCCESS) {
+ device_printf(dev, "Unable to get hardware address\n");
+ goto detach;
+ }
+ if (bufsz != ETHER_ADDR_LEN) {
+ device_printf(dev, "Invalid address length: %d bytes\n", bufsz);
+ goto detach;
+ }
+ memcpy(&sc->sc_ue.ue_eaddr, buf, ETHER_ADDR_LEN);
+
+ /* Initialize packet filter */
+ sc->sc_filter = RNDIS_PACKET_TYPE_BROADCAST |
+ RNDIS_PACKET_TYPE_ALL_MULTICAST;
+ msg_filter.filter = htole32(sc->sc_filter);
+
+ URNDIS_LOCK(sc);
+ error = urndis_ctrl_set(sc, OID_GEN_CURRENT_PACKET_FILTER,
+ &msg_filter.hdr, sizeof(msg_filter));
+ URNDIS_UNLOCK(sc);
+
+ if (error != (int)RNDIS_STATUS_SUCCESS) {
+ device_printf(dev, "Unable to set data filters\n");
+ goto detach;
+ }
+ ue->ue_sc = sc;
+ ue->ue_dev = dev;
+ ue->ue_udev = uaa->device;
+ ue->ue_mtx = &sc->sc_mtx;
+ ue->ue_methods = &urndis_ue_methods;
+
+ error = uether_ifattach(ue);
+ if (error) {
+ device_printf(dev, "Could not attach interface\n");
+ goto detach;
+ }
+
+ URNDIS_LOCK(sc);
+ /* start interrupt endpoint, if any */
+ usbd_transfer_start(sc->sc_xfer[URNDIS_INTR_RX]);
+ URNDIS_UNLOCK(sc);
+
+ return (0); /* success */
+
+detach:
+ urndis_detach(dev);
+ return (ENXIO); /* failure */
+}
+
+static int
+urndis_detach(device_t dev)
+{
+ struct urndis_softc *sc = device_get_softc(dev);
+ struct usb_ether *ue = &sc->sc_ue;
+
+ /* stop all USB transfers first */
+ usbd_transfer_unsetup(sc->sc_xfer, URNDIS_N_TRANSFER);
+
+ uether_ifdetach(ue);
+
+ mtx_destroy(&sc->sc_mtx);
+
+ return (0);
+}
+
+static void
+urndis_start(struct usb_ether *ue)
+{
+ struct urndis_softc *sc = uether_getsc(ue);
+
+ /*
+ * Start the USB transfers, if not already started:
+ */
+ usbd_transfer_start(sc->sc_xfer[URNDIS_BULK_TX]);
+ usbd_transfer_start(sc->sc_xfer[URNDIS_BULK_RX]);
+}
+
+static void
+urndis_init(struct usb_ether *ue)
+{
+ struct urndis_softc *sc = uether_getsc(ue);
+ struct ifnet *ifp = uether_getifp(ue);
+
+ URNDIS_LOCK_ASSERT(sc, MA_OWNED);
+
+ ifp->if_drv_flags |= IFF_DRV_RUNNING;
+
+ urndis_ctrl_init(sc);
+
+ /* stall data write direction, which depends on USB mode */
+ usbd_xfer_set_stall(sc->sc_xfer[URNDIS_BULK_TX]);
+
+ /* start data transfers */
+ urndis_start(ue);
+}
+
+static void
+urndis_stop(struct usb_ether *ue)
+{
+ struct urndis_softc *sc = uether_getsc(ue);
+ struct ifnet *ifp = uether_getifp(ue);
+
+ URNDIS_LOCK_ASSERT(sc, MA_OWNED);
+
+ ifp->if_drv_flags &= ~IFF_DRV_RUNNING;
+
+ /*
+ * stop all the transfers, if not already stopped:
+ */
+ usbd_transfer_stop(sc->sc_xfer[URNDIS_BULK_RX]);
+ usbd_transfer_stop(sc->sc_xfer[URNDIS_BULK_TX]);
+}
+
+static void
+urndis_setmulti(struct usb_ether *ue)
+{
+ /* no-op */
+ return;
+}
+
+static void
+urndis_setpromisc(struct usb_ether *ue)
+{
+ /* no-op */
+ return;
+}
+
+static int
+urndis_suspend(device_t dev)
+{
+ device_printf(dev, "Suspending\n");
+ return (0);
+}
+
+static int
+urndis_resume(device_t dev)
+{
+ device_printf(dev, "Resuming\n");
+ return (0);
+}
+
+static usb_error_t
+urndis_ctrl_msg(struct urndis_softc *sc, uint8_t rt, uint8_t r,
+ uint16_t index, uint16_t value, void *buf, uint16_t buflen)
+{
+ usb_device_request_t req;
+
+ req.bmRequestType = rt;
+ req.bRequest = r;
+ USETW(req.wValue, value);
+ USETW(req.wIndex, index);
+ USETW(req.wLength, buflen);
+
+ return (usbd_do_request_flags(sc->sc_ue.ue_udev,
+ &sc->sc_mtx, &req, buf, (rt & UT_READ) ?
+ USB_SHORT_XFER_OK : 0, NULL, 2000 /* ms */ ));
+}
+
+static usb_error_t
+urndis_ctrl_send(struct urndis_softc *sc, void *buf, uint16_t len)
+{
+ usb_error_t err;
+
+ err = urndis_ctrl_msg(sc, UT_WRITE_CLASS_INTERFACE, UR_GET_STATUS,
+ sc->sc_ifaceno_ctl, 0, buf, len);
+
+ DPRINTF("%s\n", usbd_errstr(err));
+
+ return (err);
+}
+
+static struct urndis_comp_hdr *
+urndis_ctrl_recv(struct urndis_softc *sc)
+{
+ struct urndis_comp_hdr *hdr;
+ usb_error_t err;
+
+ err = urndis_ctrl_msg(sc, UT_READ_CLASS_INTERFACE, UR_CLEAR_FEATURE,
+ sc->sc_ifaceno_ctl, 0, sc->sc_response_buf, RNDIS_RESPONSE_LEN);
+
+ if (err != USB_ERR_NORMAL_COMPLETION)
+ return (NULL);
+
+ hdr = (struct urndis_comp_hdr *)sc->sc_response_buf;
+
+ DPRINTF("type 0x%x len %u\n", le32toh(hdr->rm_type),
+ le32toh(hdr->rm_len));
+
+ if (le32toh(hdr->rm_len) > RNDIS_RESPONSE_LEN) {
+ DPRINTF("ctrl message error: wrong size %u > %u\n",
+ le32toh(hdr->rm_len), RNDIS_RESPONSE_LEN);
+ return (NULL);
+ }
+ return (hdr);
+}
+
+static uint32_t
+urndis_ctrl_handle(struct urndis_softc *sc, struct urndis_comp_hdr *hdr,
+ const void **buf, uint16_t *bufsz)
+{
+ uint32_t rval;
+
+ DPRINTF("\n");
+
+ if (buf != NULL && bufsz != NULL) {
+ *buf = NULL;
+ *bufsz = 0;
+ }
+ switch (le32toh(hdr->rm_type)) {
+ case REMOTE_NDIS_INITIALIZE_CMPLT:
+ rval = urndis_ctrl_handle_init(sc, hdr);
+ break;
+
+ case REMOTE_NDIS_QUERY_CMPLT:
+ rval = urndis_ctrl_handle_query(sc, hdr, buf, bufsz);
+ break;
+
+ case REMOTE_NDIS_RESET_CMPLT:
+ rval = urndis_ctrl_handle_reset(sc, hdr);
+ break;
+
+ case REMOTE_NDIS_KEEPALIVE_CMPLT:
+ case REMOTE_NDIS_SET_CMPLT:
+ rval = le32toh(hdr->rm_status);
+ break;
+
+ default:
+ DPRINTF("ctrl message error: unknown event 0x%x\n",
+ le32toh(hdr->rm_type));
+ rval = RNDIS_STATUS_FAILURE;
+ break;
+ }
+ return (rval);
+}
+
+static uint32_t
+urndis_ctrl_handle_init(struct urndis_softc *sc,
+ const struct urndis_comp_hdr *hdr)
+{
+ const struct urndis_init_comp *msg;
+
+ msg = (const struct urndis_init_comp *)hdr;
+
+ DPRINTF("len %u rid %u status 0x%x "
+ "ver_major %u ver_minor %u devflags 0x%x medium 0x%x pktmaxcnt %u "
+ "pktmaxsz %u align %u aflistoffset %u aflistsz %u\n",
+ le32toh(msg->rm_len),
+ le32toh(msg->rm_rid),
+ le32toh(msg->rm_status),
+ le32toh(msg->rm_ver_major),
+ le32toh(msg->rm_ver_minor),
+ le32toh(msg->rm_devflags),
+ le32toh(msg->rm_medium),
+ le32toh(msg->rm_pktmaxcnt),
+ le32toh(msg->rm_pktmaxsz),
+ le32toh(msg->rm_align),
+ le32toh(msg->rm_aflistoffset),
+ le32toh(msg->rm_aflistsz));
+
+ if (le32toh(msg->rm_status) != RNDIS_STATUS_SUCCESS) {
+ DPRINTF("init failed 0x%x\n", le32toh(msg->rm_status));
+ return (le32toh(msg->rm_status));
+ }
+ if (le32toh(msg->rm_devflags) != RNDIS_DF_CONNECTIONLESS) {
+ DPRINTF("wrong device type (current type: 0x%x)\n",
+ le32toh(msg->rm_devflags));
+ return (RNDIS_STATUS_FAILURE);
+ }
+ if (le32toh(msg->rm_medium) != RNDIS_MEDIUM_802_3) {
+ DPRINTF("medium not 802.3 (current medium: 0x%x)\n",
+ le32toh(msg->rm_medium));
+ return (RNDIS_STATUS_FAILURE);
+ }
+ sc->sc_lim_pktsz = le32toh(msg->rm_pktmaxsz);
+
+ return (le32toh(msg->rm_status));
+}
+
+static uint32_t
+urndis_ctrl_handle_query(struct urndis_softc *sc,
+ const struct urndis_comp_hdr *hdr, const void **buf, uint16_t *bufsz)
+{
+ const struct urndis_query_comp *msg;
+ uint64_t limit;
+
+ msg = (const struct urndis_query_comp *)hdr;
+
+ DPRINTF("len %u rid %u status 0x%x "
+ "buflen %u bufoff %u\n",
+ le32toh(msg->rm_len),
+ le32toh(msg->rm_rid),
+ le32toh(msg->rm_status),
+ le32toh(msg->rm_infobuflen),
+ le32toh(msg->rm_infobufoffset));
+
+ if (buf != NULL && bufsz != NULL) {
+ *buf = NULL;
+ *bufsz = 0;
+ }
+ if (le32toh(msg->rm_status) != RNDIS_STATUS_SUCCESS) {
+ DPRINTF("query failed 0x%x\n", le32toh(msg->rm_status));
+ return (le32toh(msg->rm_status));
+ }
+ limit = le32toh(msg->rm_infobuflen);
+ limit += le32toh(msg->rm_infobufoffset);
+ limit += RNDIS_HEADER_OFFSET;
+
+ if (limit > (uint64_t)le32toh(msg->rm_len)) {
+ DPRINTF("ctrl message error: invalid query info "
+ "len/offset/end_position(%u/%u/%u) -> "
+ "go out of buffer limit %u\n",
+ le32toh(msg->rm_infobuflen),
+ le32toh(msg->rm_infobufoffset),
+ le32toh(msg->rm_infobuflen) +
+ le32toh(msg->rm_infobufoffset) + RNDIS_HEADER_OFFSET,
+ le32toh(msg->rm_len));
+ return (RNDIS_STATUS_FAILURE);
+ }
+ if (buf != NULL && bufsz != NULL) {
+ *buf = ((const uint8_t *)msg) + RNDIS_HEADER_OFFSET + le32toh(msg->rm_infobufoffset);
+ *bufsz = le32toh(msg->rm_infobuflen);
+ }
+ return (le32toh(msg->rm_status));
+}
+
+static uint32_t
+urndis_ctrl_handle_reset(struct urndis_softc *sc,
+ const struct urndis_comp_hdr *hdr)
+{
+ const struct urndis_reset_comp *msg;
+ uint32_t rval;
+
+ msg = (const struct urndis_reset_comp *)hdr;
+
+ rval = le32toh(msg->rm_status);
+
+ DPRINTF("len %u status 0x%x "
+ "adrreset %u\n",
+ le32toh(msg->rm_len),
+ rval,
+ le32toh(msg->rm_adrreset));
+
+ if (rval != RNDIS_STATUS_SUCCESS) {
+ DPRINTF("reset failed 0x%x\n", rval);
+ return (rval);
+ }
+ if (msg->rm_adrreset != 0) {
+ struct {
+ struct urndis_set_req hdr;
+ uint32_t filter;
+ } msg_filter;
+
+ msg_filter.filter = htole32(sc->sc_filter);
+
+ rval = urndis_ctrl_set(sc, OID_GEN_CURRENT_PACKET_FILTER,
+ &msg_filter.hdr, sizeof(msg_filter));
+
+ if (rval != RNDIS_STATUS_SUCCESS) {
+ DPRINTF("unable to reset data filters\n");
+ return (rval);
+ }
+ }
+ return (rval);
+}
+
+static uint32_t
+urndis_ctrl_init(struct urndis_softc *sc)
+{
+ struct urndis_init_req msg;
+ struct urndis_comp_hdr *hdr;
+ uint32_t rval;
+
+ msg.rm_type = htole32(REMOTE_NDIS_INITIALIZE_MSG);
+ msg.rm_len = htole32(sizeof(msg));
+ msg.rm_rid = htole32(0);
+ msg.rm_ver_major = htole32(1);
+ msg.rm_ver_minor = htole32(1);
+ msg.rm_max_xfersz = htole32(RNDIS_RX_MAXLEN);
+
+ DPRINTF("type %u len %u rid %u ver_major %u "
+ "ver_minor %u max_xfersz %u\n",
+ le32toh(msg.rm_type),
+ le32toh(msg.rm_len),
+ le32toh(msg.rm_rid),
+ le32toh(msg.rm_ver_major),
+ le32toh(msg.rm_ver_minor),
+ le32toh(msg.rm_max_xfersz));
+
+ rval = urndis_ctrl_send(sc, &msg, sizeof(msg));
+
+ if (rval != RNDIS_STATUS_SUCCESS) {
+ DPRINTF("init failed\n");
+ return (rval);
+ }
+ if ((hdr = urndis_ctrl_recv(sc)) == NULL) {
+ DPRINTF("unable to get init response\n");
+ return (RNDIS_STATUS_FAILURE);
+ }
+ rval = urndis_ctrl_handle(sc, hdr, NULL, NULL);
+
+ return (rval);
+}
+
+#if 0
+static uint32_t
+urndis_ctrl_halt(struct urndis_softc *sc)
+{
+ struct urndis_halt_req msg;
+ uint32_t rval;
+
+ msg.rm_type = htole32(REMOTE_NDIS_HALT_MSG);
+ msg.rm_len = htole32(sizeof(msg));
+ msg.rm_rid = 0;
+
+ DPRINTF("type %u len %u rid %u\n",
+ le32toh(msg.rm_type),
+ le32toh(msg.rm_len),
+ le32toh(msg.rm_rid));
+
+ rval = urndis_ctrl_send(sc, &msg, sizeof(msg));
+
+ if (rval != RNDIS_STATUS_SUCCESS)
+ printf("halt failed\n");
+
+ return (rval);
+}
+
+#endif
+
+static uint32_t
+urndis_ctrl_query(struct urndis_softc *sc, uint32_t oid, const void **rbuf, uint16_t *rbufsz)
+{
+ struct urndis_query_req msg;
+ uint32_t rval;
+ struct urndis_comp_hdr *hdr;
+
+ msg.rm_type = htole32(REMOTE_NDIS_QUERY_MSG);
+ msg.rm_len = htole32(sizeof(msg));
+ msg.rm_rid = 0; /* XXX */
+ msg.rm_oid = htole32(oid);
+ msg.rm_infobuflen = htole32(0);
+ msg.rm_infobufoffset = 0;
+ msg.rm_devicevchdl = 0;
+
+ DPRINTF("type %u len %u rid %u oid 0x%x "
+ "infobuflen %u infobufoffset %u devicevchdl %u\n",
+ le32toh(msg.rm_type),
+ le32toh(msg.rm_len),
+ le32toh(msg.rm_rid),
+ le32toh(msg.rm_oid),
+ le32toh(msg.rm_infobuflen),
+ le32toh(msg.rm_infobufoffset),
+ le32toh(msg.rm_devicevchdl));
+
+ rval = urndis_ctrl_send(sc, &msg, sizeof(msg));
+
+ if (rval != RNDIS_STATUS_SUCCESS) {
+ DPRINTF("query failed\n");
+ return (rval);
+ }
+ if ((hdr = urndis_ctrl_recv(sc)) == NULL) {
+ DPRINTF("unable to get query response\n");
+ return (RNDIS_STATUS_FAILURE);
+ }
+ rval = urndis_ctrl_handle(sc, hdr, rbuf, rbufsz);
+
+ return (rval);
+}
+
+static uint32_t
+urndis_ctrl_set(struct urndis_softc *sc, uint32_t oid, struct urndis_set_req *msg, uint16_t len)
+{
+ struct urndis_comp_hdr *hdr;
+ uint32_t rval;
+ uint32_t datalen = len - sizeof(*msg);
+
+ msg->rm_type = htole32(REMOTE_NDIS_SET_MSG);
+ msg->rm_len = htole32(len);
+ msg->rm_rid = 0; /* XXX */
+ msg->rm_oid = htole32(oid);
+ msg->rm_infobuflen = htole32(datalen);
+ if (datalen != 0) {
+ msg->rm_infobufoffset = htole32(sizeof(*msg) - RNDIS_HEADER_OFFSET);
+ } else {
+ msg->rm_infobufoffset = 0;
+ }
+ msg->rm_devicevchdl = 0;
+
+ DPRINTF("type %u len %u rid %u oid 0x%x "
+ "infobuflen %u infobufoffset %u devicevchdl %u\n",
+ le32toh(msg->rm_type),
+ le32toh(msg->rm_len),
+ le32toh(msg->rm_rid),
+ le32toh(msg->rm_oid),
+ le32toh(msg->rm_infobuflen),
+ le32toh(msg->rm_infobufoffset),
+ le32toh(msg->rm_devicevchdl));
+
+ rval = urndis_ctrl_send(sc, msg, len);
+
+ if (rval != RNDIS_STATUS_SUCCESS) {
+ DPRINTF("set failed\n");
+ return (rval);
+ }
+ if ((hdr = urndis_ctrl_recv(sc)) == NULL) {
+ DPRINTF("unable to get set response\n");
+ return (RNDIS_STATUS_FAILURE);
+ }
+ rval = urndis_ctrl_handle(sc, hdr, NULL, NULL);
+ if (rval != RNDIS_STATUS_SUCCESS)
+ DPRINTF("set failed 0x%x\n", rval);
+
+ return (rval);
+}
+
+static void
+urndis_bulk_read_callback(struct usb_xfer *xfer, usb_error_t error)
+{
+ struct urndis_softc *sc = usbd_xfer_softc(xfer);
+ struct usb_page_cache *pc = usbd_xfer_get_frame(xfer, 0);
+ struct ifnet *ifp = uether_getifp(&sc->sc_ue);
+ struct urndis_packet_msg msg;
+ struct mbuf *m;
+ int actlen;
+ int aframes;
+ int offset;
+
+ switch (USB_GET_STATE(xfer)) {
+ case USB_ST_TRANSFERRED:
+
+ usbd_xfer_status(xfer, &actlen, NULL, &aframes, NULL);
+
+ DPRINTFN(1, "received %u bytes in %u frames\n", actlen, aframes);
+
+ for (offset = 0; actlen >= (uint32_t)sizeof(msg);) {
+
+ /* copy out header */
+ usbd_copy_out(pc, offset, &msg, sizeof(msg));
+
+ if (le32toh(0x1234567U) != 0x1234567U) {
+ /* swap endianness */
+ msg.rm_type = le32toh(msg.rm_type);
+ msg.rm_len = le32toh(msg.rm_len);
+ msg.rm_dataoffset = le32toh(msg.rm_dataoffset);
+ msg.rm_datalen = le32toh(msg.rm_datalen);
+ msg.rm_oobdataoffset = le32toh(msg.rm_oobdataoffset);
+ msg.rm_oobdatalen = le32toh(msg.rm_oobdatalen);
+ msg.rm_oobdataelements = le32toh(msg.rm_oobdataelements);
+ msg.rm_pktinfooffset = le32toh(msg.rm_pktinfooffset);
+ msg.rm_pktinfolen = le32toh(msg.rm_pktinfolen);
+ msg.rm_vchandle = le32toh(msg.rm_vchandle);
+ msg.rm_reserved = le32toh(msg.rm_reserved);
+ }
+
+ DPRINTF("len %u data(off:%u len:%u) "
+ "oobdata(off:%u len:%u nb:%u) perpacket(off:%u len:%u)\n",
+ msg.rm_len, msg.rm_dataoffset, msg.rm_datalen,
+ msg.rm_oobdataoffset, msg.rm_oobdatalen,
+ msg.rm_oobdataelements, msg.rm_pktinfooffset,
+ msg.rm_pktinfooffset);
+
+ /* sanity check the RNDIS header */
+ if (msg.rm_type != REMOTE_NDIS_PACKET_MSG) {
+ DPRINTF("invalid type 0x%x != 0x%x\n",
+ msg.rm_type, REMOTE_NDIS_PACKET_MSG);
+ goto tr_setup;
+ } else if (msg.rm_len < (uint32_t)sizeof(msg)) {
+ DPRINTF("invalid msg len %u < %u\n",
+ msg.rm_len, (unsigned)sizeof(msg));
+ goto tr_setup;
+ } else if (msg.rm_len > (uint32_t)actlen) {
+ DPRINTF("invalid msg len %u > buffer "
+ "len %u\n", msg.rm_len, actlen);
+ goto tr_setup;
+ } else if (msg.rm_dataoffset >= (uint32_t)actlen) {
+ DPRINTF("invalid msg dataoffset %u > buffer "
+ "dataoffset %u\n", msg.rm_dataoffset, actlen);
+ goto tr_setup;
+ } else if (msg.rm_datalen > (uint32_t)actlen) {
+ DPRINTF("invalid msg datalen %u > buffer "
+ "datalen %u\n", msg.rm_datalen, actlen);
+ goto tr_setup;
+ } else if ((msg.rm_dataoffset + msg.rm_datalen +
+ (uint32_t)__offsetof(struct urndis_packet_msg,
+ rm_dataoffset)) > (uint32_t)actlen) {
+ DPRINTF("invalid dataoffset %u larger than %u\n",
+ msg.rm_dataoffset + msg.rm_datalen +
+ (uint32_t)__offsetof(struct urndis_packet_msg,
+ rm_dataoffset));
+ goto tr_setup;
+ } else if (msg.rm_datalen < (uint32_t)sizeof(struct ether_header)) {
+ ifp->if_ierrors++;
+ DPRINTF("invalid ethernet size "
+ "%u < %u\n", msg.rm_datalen, (unsigned)sizeof(struct ether_header));
+ goto tr_setup;
+ } else if (msg.rm_datalen > (uint32_t)MCLBYTES) {
+ ifp->if_ierrors++;
+ DPRINTF("invalid ethernet size "
+ "%u > %u\n",
+ msg.rm_datalen, (unsigned)MCLBYTES);
+ goto tr_setup;
+ } else if (msg.rm_datalen > (uint32_t)(MHLEN - ETHER_ALIGN)) {
+ m = m_getcl(M_NOWAIT, MT_DATA, M_PKTHDR);
+ } else {
+ m = m_gethdr(M_NOWAIT, MT_DATA);
+ }
+
+ /* check if we have a buffer */
+ if (m != NULL) {
+ m_adj(m, ETHER_ALIGN);
+
+ usbd_copy_out(pc, offset + msg.rm_dataoffset +
+ __offsetof(struct urndis_packet_msg,
+ rm_dataoffset), m->m_data, msg.rm_datalen);
+
+ /* enqueue */
+ uether_rxmbuf(&sc->sc_ue, m, msg.rm_datalen);
+ } else {
+ ifp->if_ierrors++;
+ }
+ offset += msg.rm_len;
+ actlen -= msg.rm_len;
+ }
+
+ case USB_ST_SETUP:
+tr_setup:
+ usbd_xfer_set_frame_len(xfer, 0, RNDIS_RX_MAXLEN);
+ usbd_xfer_set_frames(xfer, 1);
+ usbd_transfer_submit(xfer);
+ uether_rxflush(&sc->sc_ue); /* must be last */
+ break;
+
+ default: /* Error */
+ DPRINTFN(1, "error = %s\n", usbd_errstr(error));
+
+ if (error != USB_ERR_CANCELLED) {
+ /* try to clear stall first */
+ usbd_xfer_set_stall(xfer);
+ usbd_xfer_set_frames(xfer, 0);
+ usbd_transfer_submit(xfer);
+ }
+ break;
+ }
+}
+
+static void
+urndis_bulk_write_callback(struct usb_xfer *xfer, usb_error_t error)
+{
+ struct urndis_packet_msg msg;
+ struct urndis_softc *sc = usbd_xfer_softc(xfer);
+ struct ifnet *ifp = uether_getifp(&sc->sc_ue);
+ struct mbuf *m;
+ unsigned x;
+ int actlen;
+ int aframes;
+
+ usbd_xfer_status(xfer, &actlen, NULL, &aframes, NULL);
+
+ DPRINTFN(1, "\n");
+
+ switch (USB_GET_STATE(xfer)) {
+ case USB_ST_TRANSFERRED:
+ DPRINTFN(11, "%u bytes in %u frames\n", actlen, aframes);
+
+ ifp->if_opackets++;
+
+ /* FALLTHROUGH */
+ case USB_ST_SETUP:
+tr_setup:
+ memset(&msg, 0, sizeof(msg));
+
+ for (x = 0; x != RNDIS_TX_FRAMES_MAX; x++) {
+ struct usb_page_cache *pc = usbd_xfer_get_frame(xfer, x);
+
+ usbd_xfer_set_frame_offset(xfer, x * RNDIS_TX_MAXLEN, x);
+
+ next_pkt:
+ IFQ_DRV_DEQUEUE(&ifp->if_snd, m);
+
+ if (m == NULL)
+ break;
+
+ if ((m->m_pkthdr.len + sizeof(msg)) > RNDIS_TX_MAXLEN) {
+ DPRINTF("Too big packet\n");
+ ifp->if_oerrors++;
+
+ /* Free buffer */
+ m_freem(m);
+ goto next_pkt;
+ }
+ msg.rm_type = htole32(REMOTE_NDIS_PACKET_MSG);
+ msg.rm_len = htole32(sizeof(msg) + m->m_pkthdr.len);
+
+ msg.rm_dataoffset = htole32(RNDIS_DATA_OFFSET);
+ msg.rm_datalen = htole32(m->m_pkthdr.len);
+
+ /* copy in all data */
+ usbd_copy_in(pc, 0, &msg, sizeof(msg));
+ usbd_m_copy_in(pc, sizeof(msg), m, 0, m->m_pkthdr.len);
+ usbd_xfer_set_frame_len(xfer, x, sizeof(msg) + m->m_pkthdr.len);
+
+ /*
+ * If there's a BPF listener, bounce a copy of
+ * this frame to him:
+ */
+ BPF_MTAP(ifp, m);
+
+ /* Free buffer */
+ m_freem(m);
+ }
+ if (x != 0) {
+ usbd_xfer_set_frames(xfer, x);
+ usbd_transfer_submit(xfer);
+ }
+ break;
+
+ default: /* Error */
+ DPRINTFN(11, "transfer error, %s\n", usbd_errstr(error));
+
*** DIFF OUTPUT TRUNCATED AT 1000 LINES ***
More information about the svn-src-head
mailing list