2 * SPDX-License-Identifier: BSD-2-Clause-FreeBSD
4 * Copyright (c) 2010 Hans Petter Selasky. All rights reserved.
6 * Redistribution and use in source and binary forms, with or without
7 * modification, are permitted provided that the following conditions
9 * 1. Redistributions of source code must retain the above copyright
10 * notice, this list of conditions and the following disclaimer.
11 * 2. Redistributions in binary form must reproduce the above copyright
12 * notice, this list of conditions and the following disclaimer in the
13 * documentation and/or other materials provided with the distribution.
15 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
16 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
17 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
18 * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
19 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
20 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
21 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
22 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
23 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
24 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
29 * Comm Class spec: http://www.usb.org/developers/devclass_docs/usbccs10.pdf
30 * http://www.usb.org/developers/devclass_docs/usbcdc11.pdf
31 * http://www.usb.org/developers/devclass_docs/cdc_wmc10.zip
34 #include <sys/param.h>
35 __FBSDID("$FreeBSD$");
37 #include <sys/stdint.h>
38 #include <sys/stddef.h>
39 #include <sys/queue.h>
40 #include <sys/systm.h>
41 #include <sys/kernel.h>
43 #include <sys/linker_set.h>
44 #include <sys/module.h>
46 #include <sys/mutex.h>
47 #include <sys/condvar.h>
48 #include <sys/sysctl.h>
50 #include <sys/unistd.h>
51 #include <sys/callout.h>
52 #include <sys/malloc.h>
55 #include <dev/usb/usb.h>
56 #include <dev/usb/usb_cdc.h>
57 #include <dev/usb/usbdi.h>
58 #include <dev/usb/usbdi_util.h>
59 #include <dev/usb/usbhid.h>
62 #define USB_DEBUG_VAR g_modem_debug
63 #include <dev/usb/usb_debug.h>
65 #include <dev/usb/gadget/g_modem.h>
74 struct g_modem_softc {
76 struct usb_callout sc_callout;
77 struct usb_callout sc_watchdog;
78 struct usb_xfer *sc_xfer[G_MODEM_N_TRANSFER];
86 char sc_pattern[G_MODEM_MAX_STRLEN];
90 uint8_t sc_data_buf[G_MODEM_BUFSIZE];
91 uint8_t sc_line_coding[32];
92 uint8_t sc_abstract_state[32];
95 static SYSCTL_NODE(_hw_usb, OID_AUTO, g_modem, CTLFLAG_RW, 0, "USB modem gadget");
98 static int g_modem_debug = 0;
100 SYSCTL_INT(_hw_usb_g_modem, OID_AUTO, debug, CTLFLAG_RWTUN,
101 &g_modem_debug, 0, "Debug level");
104 static int g_modem_mode = 0;
106 SYSCTL_INT(_hw_usb_g_modem, OID_AUTO, mode, CTLFLAG_RWTUN,
107 &g_modem_mode, 0, "Mode selection");
109 static int g_modem_pattern_interval = 1000;
111 SYSCTL_INT(_hw_usb_g_modem, OID_AUTO, pattern_interval, CTLFLAG_RWTUN,
112 &g_modem_pattern_interval, 0, "Pattern interval in milliseconds");
114 static char g_modem_pattern_data[G_MODEM_MAX_STRLEN];
116 SYSCTL_STRING(_hw_usb_g_modem, OID_AUTO, pattern, CTLFLAG_RW,
117 &g_modem_pattern_data, sizeof(g_modem_pattern_data), "Data pattern");
119 static int g_modem_throughput;
121 SYSCTL_INT(_hw_usb_g_modem, OID_AUTO, throughput, CTLFLAG_RD,
122 &g_modem_throughput, sizeof(g_modem_throughput), "Throughput in bytes per second");
124 static device_probe_t g_modem_probe;
125 static device_attach_t g_modem_attach;
126 static device_detach_t g_modem_detach;
127 static usb_handle_request_t g_modem_handle_request;
128 static usb_callback_t g_modem_intr_callback;
129 static usb_callback_t g_modem_bulk_read_callback;
130 static usb_callback_t g_modem_bulk_write_callback;
132 static void g_modem_timeout(void *arg);
134 static devclass_t g_modem_devclass;
136 static device_method_t g_modem_methods[] = {
138 DEVMETHOD(usb_handle_request, g_modem_handle_request),
140 /* Device interface */
141 DEVMETHOD(device_probe, g_modem_probe),
142 DEVMETHOD(device_attach, g_modem_attach),
143 DEVMETHOD(device_detach, g_modem_detach),
148 static driver_t g_modem_driver = {
150 .methods = g_modem_methods,
151 .size = sizeof(struct g_modem_softc),
154 DRIVER_MODULE(g_modem, uhub, g_modem_driver, g_modem_devclass, 0, 0);
155 MODULE_DEPEND(g_modem, usb, 1, 1, 1);
157 static const struct usb_config g_modem_config[G_MODEM_N_TRANSFER] = {
159 [G_MODEM_INTR_DT] = {
160 .type = UE_INTERRUPT,
161 .endpoint = UE_ADDR_ANY,
162 .direction = UE_DIR_TX,
163 .flags = {.ext_buffer = 1,.pipe_bof = 1,},
164 .bufsize = 0, /* use wMaxPacketSize */
165 .callback = &g_modem_intr_callback,
167 .usb_mode = USB_MODE_DEVICE,
171 [G_MODEM_BULK_RD] = {
173 .endpoint = UE_ADDR_ANY,
174 .direction = UE_DIR_RX,
175 .flags = {.ext_buffer = 1,.pipe_bof = 1,.short_xfer_ok = 1,},
176 .bufsize = G_MODEM_BUFSIZE,
177 .callback = &g_modem_bulk_read_callback,
179 .usb_mode = USB_MODE_DEVICE,
183 [G_MODEM_BULK_WR] = {
185 .endpoint = UE_ADDR_ANY,
186 .direction = UE_DIR_TX,
187 .flags = {.ext_buffer = 1,.pipe_bof = 1,},
188 .bufsize = G_MODEM_BUFSIZE,
189 .callback = &g_modem_bulk_write_callback,
191 .usb_mode = USB_MODE_DEVICE,
197 g_modem_timeout_reset(struct g_modem_softc *sc)
199 int i = g_modem_pattern_interval;
201 sc->sc_tx_interval = i;
208 i = USB_MS_TO_TICKS(i);
210 usb_callout_reset(&sc->sc_callout, i, &g_modem_timeout, sc);
214 g_modem_timeout(void *arg)
216 struct g_modem_softc *sc = arg;
218 sc->sc_mode = g_modem_mode;
220 memcpy(sc->sc_pattern, g_modem_pattern_data, sizeof(sc->sc_pattern));
222 sc->sc_pattern[G_MODEM_MAX_STRLEN - 1] = 0;
224 sc->sc_pattern_len = strlen(sc->sc_pattern);
226 DPRINTFN(11, "Timeout %p\n", sc->sc_xfer[G_MODEM_INTR_DT]);
228 usbd_transfer_start(sc->sc_xfer[G_MODEM_BULK_WR]);
229 usbd_transfer_start(sc->sc_xfer[G_MODEM_BULK_RD]);
231 g_modem_timeout_reset(sc);
234 static void g_modem_watchdog(void *arg);
237 g_modem_watchdog_reset(struct g_modem_softc *sc)
239 usb_callout_reset(&sc->sc_watchdog, hz, &g_modem_watchdog, sc);
243 g_modem_watchdog(void *arg)
245 struct g_modem_softc *sc = arg;
248 i = sc->sc_throughput;
250 sc->sc_throughput = 0;
252 g_modem_throughput = i;
254 g_modem_watchdog_reset(sc);
258 g_modem_probe(device_t dev)
260 struct usb_attach_arg *uaa = device_get_ivars(dev);
264 if (uaa->usb_mode != USB_MODE_DEVICE)
267 if ((uaa->info.bInterfaceClass == UICLASS_CDC) &&
268 (uaa->info.bInterfaceSubClass == UISUBCLASS_ABSTRACT_CONTROL_MODEL) &&
269 (uaa->info.bInterfaceProtocol == UIPROTO_CDC_AT))
276 g_modem_attach(device_t dev)
278 struct g_modem_softc *sc = device_get_softc(dev);
279 struct usb_attach_arg *uaa = device_get_ivars(dev);
281 uint8_t iface_index[2];
285 device_set_usb_desc(dev);
287 mtx_init(&sc->sc_mtx, "g_modem", NULL, MTX_DEF);
289 usb_callout_init_mtx(&sc->sc_callout, &sc->sc_mtx, 0);
290 usb_callout_init_mtx(&sc->sc_watchdog, &sc->sc_mtx, 0);
292 sc->sc_mode = G_MODEM_MODE_SILENT;
294 iface_index[0] = uaa->info.bIfaceIndex;
295 iface_index[1] = uaa->info.bIfaceIndex + 1;
297 error = usbd_transfer_setup(uaa->device,
298 iface_index, sc->sc_xfer, g_modem_config,
299 G_MODEM_N_TRANSFER, sc, &sc->sc_mtx);
302 DPRINTF("error=%s\n", usbd_errstr(error));
305 usbd_set_parent_iface(uaa->device, iface_index[1], iface_index[0]);
307 mtx_lock(&sc->sc_mtx);
308 g_modem_timeout_reset(sc);
309 g_modem_watchdog_reset(sc);
310 mtx_unlock(&sc->sc_mtx);
312 return (0); /* success */
317 return (ENXIO); /* error */
321 g_modem_detach(device_t dev)
323 struct g_modem_softc *sc = device_get_softc(dev);
327 mtx_lock(&sc->sc_mtx);
328 usb_callout_stop(&sc->sc_callout);
329 usb_callout_stop(&sc->sc_watchdog);
330 mtx_unlock(&sc->sc_mtx);
332 usbd_transfer_unsetup(sc->sc_xfer, G_MODEM_N_TRANSFER);
334 usb_callout_drain(&sc->sc_callout);
335 usb_callout_drain(&sc->sc_watchdog);
337 mtx_destroy(&sc->sc_mtx);
343 g_modem_intr_callback(struct usb_xfer *xfer, usb_error_t error)
348 usbd_xfer_status(xfer, &actlen, NULL, &aframes, NULL);
350 DPRINTF("st=%d aframes=%d actlen=%d bytes\n",
351 USB_GET_STATE(xfer), aframes, actlen);
353 switch (USB_GET_STATE(xfer)) {
354 case USB_ST_TRANSFERRED:
362 DPRINTF("error=%s\n", usbd_errstr(error));
364 if (error != USB_ERR_CANCELLED) {
365 /* try to clear stall first */
366 usbd_xfer_set_stall(xfer);
374 g_modem_bulk_write_callback(struct usb_xfer *xfer, usb_error_t error)
376 struct g_modem_softc *sc = usbd_xfer_softc(xfer);
383 usbd_xfer_status(xfer, &actlen, NULL, &aframes, NULL);
385 DPRINTF("st=%d aframes=%d actlen=%d bytes\n",
386 USB_GET_STATE(xfer), aframes, actlen);
388 switch (USB_GET_STATE(xfer)) {
389 case USB_ST_TRANSFERRED:
392 sc->sc_throughput += actlen;
394 if (sc->sc_mode == G_MODEM_MODE_LOOP) {
396 usbd_transfer_start(sc->sc_xfer[G_MODEM_BULK_RD]);
398 } else if ((sc->sc_mode == G_MODEM_MODE_PATTERN) && (sc->sc_tx_interval != 0)) {
399 /* wait for next timeout */
404 if (sc->sc_mode == G_MODEM_MODE_PATTERN) {
406 mod = sc->sc_pattern_len;
407 max = sc->sc_tx_interval ? mod : G_MODEM_BUFSIZE;
410 for (x = 0; x != max; x++)
411 sc->sc_data_buf[x] = x % 255;
413 for (x = 0; x != max; x++)
414 sc->sc_data_buf[x] = sc->sc_pattern[x % mod];
417 usbd_xfer_set_frame_data(xfer, 0, sc->sc_data_buf, max);
418 usbd_xfer_set_interval(xfer, 0);
419 usbd_xfer_set_frames(xfer, 1);
420 usbd_transfer_submit(xfer);
422 } else if (sc->sc_mode == G_MODEM_MODE_LOOP) {
424 if (sc->sc_tx_busy == 0)
427 x = sc->sc_tx_interval;
434 usbd_xfer_set_frame_data(xfer, 0, sc->sc_data_buf, sc->sc_data_len);
435 usbd_xfer_set_interval(xfer, x);
436 usbd_xfer_set_frames(xfer, 1);
437 usbd_transfer_submit(xfer);
444 DPRINTF("error=%s\n", usbd_errstr(error));
446 if (error != USB_ERR_CANCELLED) {
447 /* try to clear stall first */
448 usbd_xfer_set_stall(xfer);
456 g_modem_bulk_read_callback(struct usb_xfer *xfer, usb_error_t error)
458 struct g_modem_softc *sc = usbd_xfer_softc(xfer);
462 usbd_xfer_status(xfer, &actlen, NULL, &aframes, NULL);
464 DPRINTF("st=%d aframes=%d actlen=%d bytes\n",
465 USB_GET_STATE(xfer), aframes, actlen);
467 switch (USB_GET_STATE(xfer)) {
468 case USB_ST_TRANSFERRED:
470 sc->sc_throughput += actlen;
472 if (sc->sc_mode == G_MODEM_MODE_LOOP) {
474 sc->sc_data_len = actlen;
475 usbd_transfer_start(sc->sc_xfer[G_MODEM_BULK_WR]);
481 if ((sc->sc_mode == G_MODEM_MODE_SILENT) ||
482 (sc->sc_tx_busy != 0))
485 usbd_xfer_set_frame_data(xfer, 0, sc->sc_data_buf, G_MODEM_BUFSIZE);
486 usbd_xfer_set_frames(xfer, 1);
487 usbd_transfer_submit(xfer);
491 DPRINTF("error=%s\n", usbd_errstr(error));
493 if (error != USB_ERR_CANCELLED) {
494 /* try to clear stall first */
495 usbd_xfer_set_stall(xfer);
504 g_modem_handle_request(device_t dev,
505 const void *preq, void **pptr, uint16_t *plen,
506 uint16_t offset, uint8_t *pstate)
508 struct g_modem_softc *sc = device_get_softc(dev);
509 const struct usb_device_request *req = preq;
510 uint8_t is_complete = *pstate;
513 if ((req->bmRequestType == UT_WRITE_CLASS_INTERFACE) &&
514 (req->bRequest == UCDC_SET_LINE_CODING) &&
515 (req->wValue[0] == 0x00) &&
516 (req->wValue[1] == 0x00)) {
519 *plen = sizeof(sc->sc_line_coding);
520 *pptr = &sc->sc_line_coding;
525 } else if ((req->bmRequestType == UT_WRITE_CLASS_INTERFACE) &&
526 (req->bRequest == UCDC_SET_COMM_FEATURE)) {
529 *plen = sizeof(sc->sc_abstract_state);
530 *pptr = &sc->sc_abstract_state;
535 } else if ((req->bmRequestType == UT_WRITE_CLASS_INTERFACE) &&
536 (req->bRequest == UCDC_SET_CONTROL_LINE_STATE)) {
539 } else if ((req->bmRequestType == UT_WRITE_CLASS_INTERFACE) &&
540 (req->bRequest == UCDC_SEND_BREAK)) {
545 return (ENXIO); /* use builtin handler */