D49431.id160164.diff
No OneTemporary
Actions

Size

9 KB

Referenced Files

None

Subscribers

None

D49431.id160164.diff
View Options

	diff --git a/sys/dev/usb/net/if_ipheth.c b/sys/dev/usb/net/if_ipheth.c
	--- a/sys/dev/usb/net/if_ipheth.c
	+++ b/sys/dev/usb/net/if_ipheth.c
	@@ -55,6 +55,7 @@
	#include <net/if_var.h>

	#include <dev/usb/usb.h>
	+#include <dev/usb/usb_cdc.h>
	#include <dev/usb/usbdi.h>
	#include <dev/usb/usbdi_util.h>
	#include "usbdevs.h"
	@@ -81,6 +82,9 @@
	static uether_fn_t ipheth_setmulti;
	static uether_fn_t ipheth_setpromisc;

	+static ipheth_consumer_t ipheth_consume_read;
	+static ipheth_consumer_t ipheth_consume_read_ncm;
	+
	#ifdef USB_DEBUG
	static int ipheth_debug = 0;

	@@ -96,7 +100,31 @@
	.direction = UE_DIR_RX,
	.frames = IPHETH_RX_FRAMES_MAX,
	.bufsize = (IPHETH_RX_FRAMES_MAX * MCLBYTES),
	- .flags = {.short_frames_ok = 1,.short_xfer_ok = 1,.ext_buffer = 1,},
	+ .flags = {.short_frames_ok = 1, .short_xfer_ok = 1, .ext_buffer = 1,},
	+ .callback = ipheth_bulk_read_callback,
	+ .timeout = 0, /* no timeout */
	+ },
	+
	+ [IPHETH_BULK_TX] = {
	+ .type = UE_BULK,
	+ .endpoint = UE_ADDR_ANY,
	+ .direction = UE_DIR_TX,
	+ .frames = IPHETH_TX_FRAMES_MAX,
	+ .bufsize = (IPHETH_TX_FRAMES_MAX * IPHETH_BUF_SIZE),
	+ .flags = {.force_short_xfer = 1,},
	+ .callback = ipheth_bulk_write_callback,
	+ .timeout = IPHETH_TX_TIMEOUT,
	+ },
	+};
	+
	+static const struct usb_config ipheth_config_ncm[IPHETH_N_TRANSFER] = {
	+ [IPHETH_BULK_RX] = {
	+ .type = UE_BULK,
	+ .endpoint = UE_ADDR_ANY,
	+ .direction = UE_DIR_RX,
	+ .frames = 1,
	+ .bufsize = IPHETH_RX_NCM_BUF_SIZE,
	+ .flags = {.short_frames_ok = 1, .short_xfer_ok = 1,},
	.callback = ipheth_bulk_read_callback,
	.timeout = 0, /* no timeout */
	},
	@@ -204,6 +232,21 @@
	return (0);
	}

	+static int
	+ipheth_enable_ncm(struct ipheth_softc *sc)
	+{
	+ struct usb_device_request req;
	+
	+ req.bmRequestType = UT_WRITE_VENDOR_INTERFACE;
	+ req.bRequest = IPHETH_CMD_ENABLE_NCM;
	+ USETW(req.wValue, 0);
	+ req.wIndex[0] = sc->sc_iface_no;
	+ req.wIndex[1] = 0;
	+ USETW(req.wLength, 0);
	+
	+ return (usbd_do_request(sc->sc_ue.ue_udev, NULL, &req, NULL) == 0);
	+}
	+
	static int
	ipheth_probe(device_t dev)
	{
	@@ -221,6 +264,7 @@
	struct ipheth_softc *sc = device_get_softc(dev);
	struct usb_ether *ue = &sc->sc_ue;
	struct usb_attach_arg *uaa = device_get_ivars(dev);
	+ const struct usb_config *config;
	int error;

	sc->sc_iface_no = uaa->info.bIfaceIndex;
	@@ -235,18 +279,29 @@
	device_printf(dev, "Cannot set alternate setting\n");
	goto detach;
	}
	- error = usbd_transfer_setup(uaa->device, &sc->sc_iface_no,
	- sc->sc_xfer, ipheth_config, IPHETH_N_TRANSFER, sc, &sc->sc_mtx);
	- if (error) {
	- device_printf(dev, "Cannot setup USB transfers\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 = &ipheth_ue_methods;

	+ if (ipheth_enable_ncm(sc)) {
	+ config = ipheth_config_ncm;
	+ sc->is_ncm = true;
	+ sc->consume = &ipheth_consume_read_ncm;
	+ } else {
	+ config = ipheth_config;
	+ sc->consume = &ipheth_consume_read;
	+ }
	+
	+ error = usbd_transfer_setup(uaa->device, &sc->sc_iface_no, sc->sc_xfer,
	+ config, IPHETH_N_TRANSFER, sc, &sc->sc_mtx);
	+ if (error) {
	+ device_printf(dev, "Cannot setup USB transfers\n");
	+ goto detach;
	+ }
	+
	error = ipheth_get_mac_addr(sc);
	if (error) {
	device_printf(dev, "Cannot get MAC address\n");
	@@ -389,12 +444,9 @@
	int actlen;
	int aframes;

	- usbd_xfer_status(xfer, &actlen, NULL, &aframes, NULL);
	-
	- DPRINTFN(1, "\n");
	-
	switch (USB_GET_STATE(xfer)) {
	case USB_ST_TRANSFERRED:
	+ usbd_xfer_status(xfer, &actlen, NULL, &aframes, NULL);
	DPRINTFN(11, "transfer complete: %u bytes in %u frames\n",
	actlen, aframes);

	@@ -471,53 +523,40 @@
	uint8_t x;
	int actlen;
	int aframes;
	- int len;
	-
	- usbd_xfer_status(xfer, &actlen, NULL, &aframes, NULL);

	switch (USB_GET_STATE(xfer)) {
	case USB_ST_TRANSFERRED:
	-
	+ usbd_xfer_status(xfer, &actlen, NULL, &aframes, NULL);
	DPRINTF("received %u bytes in %u frames\n", actlen, aframes);

	- for (x = 0; x != aframes; x++) {
	- m = sc->sc_rx_buf[x];
	- sc->sc_rx_buf[x] = NULL;
	- len = usbd_xfer_frame_len(xfer, x);
	-
	- if (len < (int)(sizeof(struct ether_header) +
	- IPHETH_RX_ADJ)) {
	- m_freem(m);
	- continue;
	- }
	-
	- m_adj(m, IPHETH_RX_ADJ);
	-
	- /* queue up mbuf */
	- uether_rxmbuf(&sc->sc_ue, m, len - IPHETH_RX_ADJ);
	- }
	+ for (x = 0; x != aframes; x++)
	+ sc->consume(xfer, x);

	/* FALLTHROUGH */
	case USB_ST_SETUP:
	-
	- for (x = 0; x != IPHETH_RX_FRAMES_MAX; x++) {
	- if (sc->sc_rx_buf[x] == NULL) {
	- m = uether_newbuf();
	- if (m == NULL)
	- goto tr_stall;
	-
	- /* cancel alignment for ethernet */
	- m_adj(m, ETHER_ALIGN);
	-
	- sc->sc_rx_buf[x] = m;
	- } else {
	- m = sc->sc_rx_buf[x];
	+ if (!sc->is_ncm) {
	+ for (x = 0; x != IPHETH_RX_FRAMES_MAX; x++) {
	+ if (sc->sc_rx_buf[x] == NULL) {
	+ m = uether_newbuf();
	+ if (m == NULL)
	+ goto tr_stall;
	+
	+ /* cancel alignment for ethernet */
	+ m_adj(m, ETHER_ALIGN);
	+
	+ sc->sc_rx_buf[x] = m;
	+ } else {
	+ m = sc->sc_rx_buf[x];
	+ }
	+ usbd_xfer_set_frame_data(xfer, x, m->m_data, m->m_len);
	}
	-
	- usbd_xfer_set_frame_data(xfer, x, m->m_data, m->m_len);
	+ usbd_xfer_set_frames(xfer, x);
	+ } else {
	+ usbd_xfer_set_frame_len(xfer, 0,
	+ IPHETH_RX_NCM_BUF_SIZE);
	+ usbd_xfer_set_frames(xfer, 1);
	}
	- /* set number of frames and start hardware */
	- usbd_xfer_set_frames(xfer, x);
	+
	usbd_transfer_submit(xfer);
	/* flush any received frames */
	uether_rxflush(&sc->sc_ue);
	@@ -539,3 +578,108 @@
	break;
	}
	}
	+
	+static void
	+ipheth_consume_read(struct usb_xfer *xfer, int x)
	+{
	+ struct ipheth_softc *sc = usbd_xfer_softc(xfer);
	+ struct mbuf *m = sc->sc_rx_buf[x];
	+ int len;
	+
	+ sc->sc_rx_buf[x] = NULL;
	+ len = usbd_xfer_frame_len(xfer, x);
	+
	+ if (len < (int)(sizeof(struct ether_header) + IPHETH_RX_ADJ)) {
	+ m_freem(m);
	+ return;
	+ }
	+
	+ m_adj(m, IPHETH_RX_ADJ);
	+
	+ /* queue up mbuf */
	+ uether_rxmbuf(&sc->sc_ue, m, len - IPHETH_RX_ADJ);
	+}
	+
	+static void
	+ipheth_consume_read_ncm(struct usb_xfer *xfer, int x)
	+{
	+ struct ipheth_softc *sc = usbd_xfer_softc(xfer);
	+ struct usb_page_cache *pc = usbd_xfer_get_frame(xfer, 0);
	+ struct ncm_softc *ncm = &sc->sc_ncm;
	+ if_t ifp = uether_getifp(&sc->sc_ue);
	+ struct mbuf *new_buf;
	+ uint8_t buffer[4];
	+ int i, actlen;
	+ uint16_t dp_offset, dp_len;
	+
	+ usbd_xfer_status(xfer, &actlen, NULL, NULL, NULL);
	+
	+ /*
	+ * Buffer starting with 0x00 0x01 does not have any Ethernet frame
	+ * The purpose of this frame is undocumented and is safe to ignore.
	+ */
	+ if (actlen == 4) {
	+ usbd_copy_out(pc, 0, buffer, 4);
	+ if (buffer[0] == 0 && buffer[1] == 1) {
	+ new_buf = uether_newbuf();
	+ if (new_buf == NULL) {
	+ device_printf(sc->sc_ue.ue_dev,
	+ "failed to create new mbuf\n");
	+ if_inc_counter(ifp, IFCOUNTER_IQDROPS, 1);
	+ return;
	+ }
	+ usbd_copy_out(pc, 0, new_buf->m_data, 4);
	+ uether_rxmbuf(&sc->sc_ue, new_buf, 4);
	+ return;
	+ }
	+ }
	+
	+ if (actlen < IPHETH_NCM_HEADER_SIZE) {
	+ usbd_xfer_set_frame_len(xfer, 0, IPHETH_RX_NCM_BUF_SIZE);
	+ usbd_xfer_set_frames(xfer, 1);
	+ usbd_transfer_submit(xfer);
	+ uether_rxflush(&sc->sc_ue);
	+ return;
	+ }
	+
	+ usbd_copy_out(pc, 0, &ncm->hdr, sizeof(ncm->hdr));
	+
	+ if (UGETDW(ncm->hdr.dwSignature) != 0x484D434E)
	+ return;
	+
	+ /* Dpt follows the hdr on iOS */
	+ if (UGETW(ncm->hdr.wDptIndex) != (int)(sizeof(struct usb_ncm16_hdr)))
	+ return;
	+
	+ usbd_copy_out(pc, UGETW(ncm->hdr.wDptIndex), &ncm->dpt,
	+ sizeof(ncm->dpt));
	+
	+ if (UGETDW(ncm->dpt.dwSignature) != 0x304D434E)
	+ return;
	+
	+ for (i = 0; i < IPHETH_NCM_DPT_DP_NUM; ++i) {
	+ usbd_copy_out(pc,
	+ UGETW(ncm->hdr.wDptIndex) + sizeof(ncm->dpt) +
	+ sizeof(ncm->dp) * i,
	+ &ncm->dp, sizeof(ncm->dp));
	+ dp_offset = UGETW(ncm->dp.wFrameIndex);
	+ dp_len = UGETW(ncm->dp.wFrameLength);
	+
	+ /* (3.3.1 USB CDC NCM spec v1.0) */
	+ if (dp_offset == 0 && dp_len == 0)
	+ break;
	+
	+ if (dp_offset < IPHETH_NCM_HEADER_SIZE \|\| dp_offset >= actlen \|\|
	+ actlen < (dp_len + dp_offset))
	+ break;
	+ new_buf = uether_newbuf();
	+ if (new_buf == NULL) {
	+ device_printf(sc->sc_ue.ue_dev,
	+ "failed to create new mbuf\n");
	+ if_inc_counter(ifp, IFCOUNTER_IQDROPS, 1);
	+ return;
	+ }
	+ usbd_copy_out(pc, dp_offset, new_buf->m_data, dp_len);
	+ uether_rxmbuf(&sc->sc_ue, new_buf, dp_len);
	+ }
	+}
	diff --git a/sys/dev/usb/net/if_iphethvar.h b/sys/dev/usb/net/if_iphethvar.h
	--- a/sys/dev/usb/net/if_iphethvar.h
	+++ b/sys/dev/usb/net/if_iphethvar.h
	@@ -41,6 +41,7 @@
	#define IPHETH_BUF_SIZE 1514
	#define IPHETH_TX_TIMEOUT 5000 /* ms */

	+#define IPHETH_RX_NCM_BUF_SIZE 65536
	#define IPHETH_RX_FRAMES_MAX 1
	#define IPHETH_TX_FRAMES_MAX 8

	@@ -55,16 +56,32 @@
	#define IPHETH_CTRL_TIMEOUT 5000 /* ms */

	#define IPHETH_CMD_GET_MACADDR 0x00
	+#define IPHETH_CMD_ENABLE_NCM 0x04
	#define IPHETH_CMD_CARRIER_CHECK 0x45

	#define IPHETH_CARRIER_ON 0x04

	+#define IPHETH_NCM_DPT_DP_NUM 22
	+#define IPHETH_NCM_DPT_HEADER_SIZE \
	+ (sizeof(struct usb_ncm16_dpt) + \
	+ IPHETH_NCM_DPT_DP_NUM * sizeof(struct usb_ncm16_dp))
	+#define IPHETH_NCM_HEADER_SIZE \
	+ (sizeof(struct usb_ncm16_hdr) + IPHETH_NCM_DPT_HEADER_SIZE)
	+
	+typedef void (ipheth_consumer_t)(struct usb_xfer *xfer, int idx);
	+
	enum {
	IPHETH_BULK_TX,
	IPHETH_BULK_RX,
	IPHETH_N_TRANSFER,
	};

	+struct ncm_softc {
	+ struct usb_ncm16_hdr hdr;
	+ struct usb_ncm16_dpt dpt;
	+ struct usb_ncm16_dp dp;
	+};
	+
	struct ipheth_softc {
	struct usb_ether sc_ue;
	struct mtx sc_mtx;
	@@ -73,9 +90,15 @@
	struct mbuf *sc_rx_buf[IPHETH_RX_FRAMES_MAX];
	struct mbuf *sc_tx_buf[IPHETH_TX_FRAMES_MAX];

	+ struct ncm_softc sc_ncm;
	+
	uint8_t sc_data[IPHETH_CTRL_BUF_SIZE];
	uint8_t sc_iface_no;
	uint8_t sc_carrier_on;
	+
	+ bool is_ncm;
	+
	+ ipheth_consumer_t *consume;
	};

	#define IPHETH_LOCK(_sc) mtx_lock(&(_sc)->sc_mtx)

File Metadata

Mime Type: text/plain
Expires: Fri, Jan 23, 10:52 PM (16 h, 33 m)
Storage Engine: blob
Storage Format: Raw Data
Storage Handle: 27890637
Default Alt Text: D49431.id160164.diff (9 KB)

D49431.id160164.diffNo OneTemporaryActions

D49431.id160164.diffView Options

File Metadata

Event Timeline

D49431.id160164.diff
No OneTemporary
Actions

D49431.id160164.diff
View Options