2 * Copyright (c) 2010 Fredrik Lindberg <fli@shapeshifter.se>
5 * Redistribution and use in source and binary forms, with or without
6 * modification, are permitted provided that the following conditions
8 * 1. Redistributions of source code must retain the above copyright
9 * notice, this list of conditions and the following disclaimer.
10 * 2. Redistributions in binary form must reproduce the above copyright
11 * notice, this list of conditions and the following disclaimer in the
12 * documentation and/or other materials provided with the distribution.
14 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
15 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
16 * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
17 * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
18 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
19 * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
20 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
21 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
22 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
23 * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
26 #include <sys/cdefs.h>
27 __FBSDID("$FreeBSD$");
29 #include <sys/param.h>
30 #include <sys/types.h>
31 #include <sys/sockio.h>
33 #include <sys/malloc.h>
34 #include <sys/kernel.h>
35 #include <sys/module.h>
36 #include <sys/socket.h>
38 #include <sys/sysctl.h>
39 #include <sys/condvar.h>
44 #include <sys/systm.h>
45 #include <sys/limits.h>
47 #include <machine/bus.h>
50 #include <net/if_types.h>
51 #include <net/netisr.h>
53 #include <netinet/in.h>
54 #include <netinet/ip.h>
55 #include <netinet/ip6.h>
57 #include <dev/usb/usb.h>
58 #include <dev/usb/usbdi.h>
59 #include <dev/usb/usbdi_util.h>
60 #include <dev/usb/usb_cdc.h>
62 #define USB_DEBUG_VAR uhso_debug
63 #include <dev/usb/usb_debug.h>
64 #include <dev/usb/usb_process.h>
65 #include <dev/usb/usb_busdma.h>
66 #include <dev/usb/usb_msctest.h>
68 #include <dev/usb/serial/usb_serial.h>
71 struct uhso_softc *ht_sc;
72 struct usb_xfer *ht_xfer[3];
73 int ht_muxport; /* Mux. port no */
80 struct usb_device *sc_udev;
82 uint32_t sc_type; /* Interface definition */
85 struct usb_xfer *sc_xfer[3];
87 uint8_t sc_iface_index;
90 struct usb_xfer * sc_ctrl_xfer[2];
91 uint8_t sc_ctrl_iface_no;
94 struct usb_xfer *sc_if_xfer[2];
96 struct mbuf *sc_mwait; /* Partial packet */
97 size_t sc_waitlen; /* No. of outstanding bytes */
98 struct ifqueue sc_rxq;
101 /* TTY related structures */
102 struct ucom_super_softc sc_super_ucom;
104 struct uhso_tty *sc_tty;
105 struct ucom_softc *sc_ucom;
111 #define UHSO_MAX_MTU 2048
114 * There are mainly two type of cards floating around.
115 * The first one has 2,3 or 4 interfaces with a multiplexed serial port
116 * and packet interface on the first interface and bulk serial ports
118 * The second type of card has several other interfaces, their purpose
119 * can be detected during run-time.
121 #define UHSO_IFACE_SPEC(usb_type, port, port_type) \
122 (((usb_type) << 24) | ((port) << 16) | (port_type))
124 #define UHSO_IFACE_USB_TYPE(x) ((x >> 24) & 0xff)
125 #define UHSO_IFACE_PORT(x) ((x >> 16) & 0xff)
126 #define UHSO_IFACE_PORT_TYPE(x) (x & 0xff)
129 * USB interface types
131 #define UHSO_IF_NET 0x01 /* Network packet interface */
132 #define UHSO_IF_MUX 0x02 /* Multiplexed serial port */
133 #define UHSO_IF_BULK 0x04 /* Bulk interface */
138 #define UHSO_PORT_UNKNOWN 0x00
139 #define UHSO_PORT_SERIAL 0x01 /* Serial port */
140 #define UHSO_PORT_NETWORK 0x02 /* Network packet interface */
143 * Multiplexed serial port destination sub-port names
145 #define UHSO_MPORT_TYPE_CTL 0x00 /* Control port */
146 #define UHSO_MPORT_TYPE_APP 0x01 /* Application */
147 #define UHSO_MPORT_TYPE_PCSC 0x02
148 #define UHSO_MPORT_TYPE_GPS 0x03
149 #define UHSO_MPORT_TYPE_APP2 0x04 /* Secondary application */
150 #define UHSO_MPORT_TYPE_MAX UHSO_MPORT_TYPE_APP2
151 #define UHSO_MPORT_TYPE_NOMAX 8 /* Max number of mux ports */
155 * Note that these definitions are arbitrary and do not match the values
156 * returned by the auto config descriptor.
158 #define UHSO_PORT_TYPE_UNKNOWN 0x00
159 #define UHSO_PORT_TYPE_CTL 0x01
160 #define UHSO_PORT_TYPE_APP 0x02
161 #define UHSO_PORT_TYPE_APP2 0x03
162 #define UHSO_PORT_TYPE_MODEM 0x04
163 #define UHSO_PORT_TYPE_NETWORK 0x05
164 #define UHSO_PORT_TYPE_DIAG 0x06
165 #define UHSO_PORT_TYPE_DIAG2 0x07
166 #define UHSO_PORT_TYPE_GPS 0x08
167 #define UHSO_PORT_TYPE_GPSCTL 0x09
168 #define UHSO_PORT_TYPE_PCSC 0x0a
169 #define UHSO_PORT_TYPE_MSD 0x0b
170 #define UHSO_PORT_TYPE_VOICE 0x0c
171 #define UHSO_PORT_TYPE_MAX 0x0c
173 static eventhandler_tag uhso_etag;
175 /* Overall port type */
176 static char *uhso_port[] = {
184 * Map between interface port type read from device and description type.
185 * The position in this array is a direct map to the auto config
188 static unsigned char uhso_port_map[] = {
189 UHSO_PORT_TYPE_UNKNOWN,
192 UHSO_PORT_TYPE_GPSCTL,
196 UHSO_PORT_TYPE_NETWORK,
197 UHSO_PORT_TYPE_MODEM,
202 static char uhso_port_map_max = sizeof(uhso_port_map) / sizeof(char);
204 static unsigned char uhso_mux_port_map[] = {
212 static char *uhso_port_type[] = {
213 "Unknown", /* Not a valid port */
216 "Application (Secondary)",
220 "Diagnostic (Secondary)",
228 static char *uhso_port_type_sysctl[] = {
244 #define UHSO_STATIC_IFACE 0x01
245 #define UHSO_AUTO_IFACE 0x02
247 /* ifnet device unit allocations */
248 static struct unrhdr *uhso_ifnet_unit = NULL;
250 static const STRUCT_USB_HOST_ID uhso_devs[] = {
251 #define UHSO_DEV(v,p,i) { USB_VPI(USB_VENDOR_##v, USB_PRODUCT_##v##_##p, i) }
252 /* Option GlobeTrotter MAX 7.2 with upgraded firmware */
253 UHSO_DEV(OPTION, GTMAX72, UHSO_STATIC_IFACE),
254 /* Option GlobeSurfer iCON 7.2 */
255 UHSO_DEV(OPTION, GSICON72, UHSO_STATIC_IFACE),
256 /* Option iCON 225 */
257 UHSO_DEV(OPTION, GTHSDPA, UHSO_STATIC_IFACE),
258 /* Option GlobeSurfer iCON HSUPA */
259 UHSO_DEV(OPTION, GSICONHSUPA, UHSO_STATIC_IFACE),
260 /* Option GlobeTrotter HSUPA */
261 UHSO_DEV(OPTION, GTHSUPA, UHSO_STATIC_IFACE),
263 UHSO_DEV(OPTION, GE40X, UHSO_AUTO_IFACE),
264 UHSO_DEV(OPTION, GE40X_1, UHSO_AUTO_IFACE),
265 UHSO_DEV(OPTION, GE40X_2, UHSO_AUTO_IFACE),
266 UHSO_DEV(OPTION, GE40X_3, UHSO_AUTO_IFACE),
267 /* Option GlobeSurfer iCON 401 */
268 UHSO_DEV(OPTION, ICON401, UHSO_AUTO_IFACE),
269 /* Option GlobeTrotter Module 382 */
270 UHSO_DEV(OPTION, GMT382, UHSO_AUTO_IFACE),
271 /* Option iCON EDGE */
272 UHSO_DEV(OPTION, ICONEDGE, UHSO_STATIC_IFACE),
273 /* Option Module HSxPA */
274 UHSO_DEV(OPTION, MODHSXPA, UHSO_STATIC_IFACE),
275 /* Option iCON 321 */
276 UHSO_DEV(OPTION, ICON321, UHSO_STATIC_IFACE),
277 /* Option iCON 322 */
278 UHSO_DEV(OPTION, GTICON322, UHSO_STATIC_IFACE),
279 /* Option iCON 505 */
280 UHSO_DEV(OPTION, ICON505, UHSO_AUTO_IFACE),
281 /* Option iCON 452 */
282 UHSO_DEV(OPTION, ICON505, UHSO_AUTO_IFACE),
286 static SYSCTL_NODE(_hw_usb, OID_AUTO, uhso, CTLFLAG_RW, 0, "USB uhso");
287 static int uhso_autoswitch = 1;
288 SYSCTL_INT(_hw_usb_uhso, OID_AUTO, auto_switch, CTLFLAG_RW,
289 &uhso_autoswitch, 0, "Automatically switch to modem mode");
293 static int uhso_debug = UHSO_DEBUG;
295 static int uhso_debug = -1;
298 SYSCTL_INT(_hw_usb_uhso, OID_AUTO, debug, CTLFLAG_RW,
299 &uhso_debug, 0, "Debug level");
301 #define UHSO_DPRINTF(n, x, ...) {\
302 if (uhso_debug >= n) {\
303 printf("%s: " x, __func__, ##__VA_ARGS__);\
307 #define UHSO_DPRINTF(n, x, ...)
310 #ifdef UHSO_DEBUG_HEXDUMP
311 # define UHSO_HEXDUMP(_buf, _len) do { \
314 const char *__buf = (const char *)_buf; \
315 for (__tmp = 0; __tmp < _len; __tmp++) \
316 printf("%02hhx ", *__buf++); \
321 # define UHSO_HEXDUMP(_buf, _len)
325 UHSO_MUX_ENDPT_INTR = 0,
342 UHSO_BULK_ENDPT_READ = 0,
343 UHSO_BULK_ENDPT_WRITE,
344 UHSO_BULK_ENDPT_INTR,
348 static usb_callback_t uhso_mux_intr_callback;
349 static usb_callback_t uhso_mux_read_callback;
350 static usb_callback_t uhso_mux_write_callback;
351 static usb_callback_t uhso_bs_read_callback;
352 static usb_callback_t uhso_bs_write_callback;
353 static usb_callback_t uhso_bs_intr_callback;
354 static usb_callback_t uhso_ifnet_read_callback;
355 static usb_callback_t uhso_ifnet_write_callback;
357 /* Config used for the default control pipes */
358 static const struct usb_config uhso_ctrl_config[UHSO_CTRL_MAX] = {
362 .direction = UE_DIR_ANY,
363 .flags = { .pipe_bof = 1, .short_xfer_ok = 1 },
364 .bufsize = sizeof(struct usb_device_request) + 1024,
365 .callback = &uhso_mux_read_callback
368 [UHSO_CTRL_WRITE] = {
371 .direction = UE_DIR_ANY,
372 .flags = { .pipe_bof = 1, .force_short_xfer = 1 },
373 .bufsize = sizeof(struct usb_device_request) + 1024,
375 .callback = &uhso_mux_write_callback
379 /* Config for the multiplexed serial ports */
380 static const struct usb_config uhso_mux_config[UHSO_MUX_ENDPT_MAX] = {
381 [UHSO_MUX_ENDPT_INTR] = {
382 .type = UE_INTERRUPT,
383 .endpoint = UE_ADDR_ANY,
384 .direction = UE_DIR_IN,
385 .flags = { .short_xfer_ok = 1 },
387 .callback = &uhso_mux_intr_callback,
391 /* Config for the raw IP-packet interface */
392 static const struct usb_config uhso_ifnet_config[UHSO_IFNET_MAX] = {
393 [UHSO_IFNET_READ] = {
395 .endpoint = UE_ADDR_ANY,
396 .direction = UE_DIR_IN,
397 .flags = { .pipe_bof = 1, .short_xfer_ok = 1 },
399 .callback = &uhso_ifnet_read_callback
401 [UHSO_IFNET_WRITE] = {
403 .endpoint = UE_ADDR_ANY,
404 .direction = UE_DIR_OUT,
405 .flags = { .pipe_bof = 1, .force_short_xfer = 1 },
407 .timeout = 5 * USB_MS_HZ,
408 .callback = &uhso_ifnet_write_callback
412 /* Config for interfaces with normal bulk serial ports */
413 static const struct usb_config uhso_bs_config[UHSO_BULK_ENDPT_MAX] = {
414 [UHSO_BULK_ENDPT_READ] = {
416 .endpoint = UE_ADDR_ANY,
417 .direction = UE_DIR_IN,
418 .flags = { .pipe_bof = 1, .short_xfer_ok = 1 },
420 .callback = &uhso_bs_read_callback
423 [UHSO_BULK_ENDPT_WRITE] = {
425 .endpoint = UE_ADDR_ANY,
426 .direction = UE_DIR_OUT,
427 .flags = { .pipe_bof = 1, .force_short_xfer = 1 },
429 .callback = &uhso_bs_write_callback
432 [UHSO_BULK_ENDPT_INTR] = {
433 .type = UE_INTERRUPT,
434 .endpoint = UE_ADDR_ANY,
435 .direction = UE_DIR_IN,
436 .flags = { .short_xfer_ok = 1 },
438 .callback = &uhso_bs_intr_callback,
442 static int uhso_probe_iface(struct uhso_softc *, int,
443 int (*probe)(struct usb_device *, int));
444 static int uhso_probe_iface_auto(struct usb_device *, int);
445 static int uhso_probe_iface_static(struct usb_device *, int);
446 static int uhso_attach_muxserial(struct uhso_softc *, struct usb_interface *,
448 static int uhso_attach_bulkserial(struct uhso_softc *, struct usb_interface *,
450 static int uhso_attach_ifnet(struct uhso_softc *, struct usb_interface *,
452 static void uhso_test_autoinst(void *, struct usb_device *,
453 struct usb_attach_arg *);
454 static int uhso_driver_loaded(struct module *, int, void *);
455 static int uhso_radio_sysctl(SYSCTL_HANDLER_ARGS);
456 static int uhso_radio_ctrl(struct uhso_softc *, int);
458 static void uhso_ucom_start_read(struct ucom_softc *);
459 static void uhso_ucom_stop_read(struct ucom_softc *);
460 static void uhso_ucom_start_write(struct ucom_softc *);
461 static void uhso_ucom_stop_write(struct ucom_softc *);
462 static void uhso_ucom_cfg_get_status(struct ucom_softc *, uint8_t *, uint8_t *);
463 static void uhso_ucom_cfg_set_dtr(struct ucom_softc *, uint8_t);
464 static void uhso_ucom_cfg_set_rts(struct ucom_softc *, uint8_t);
465 static void uhso_if_init(void *);
466 static void uhso_if_start(struct ifnet *, struct ifaltq_subque *);
467 static void uhso_if_stop(struct uhso_softc *);
468 static int uhso_if_ioctl(struct ifnet *, u_long, caddr_t);
469 static int uhso_if_output(struct ifnet *, struct mbuf *, struct sockaddr *,
471 static void uhso_if_rxflush(void *);
473 static device_probe_t uhso_probe;
474 static device_attach_t uhso_attach;
475 static device_detach_t uhso_detach;
477 static device_method_t uhso_methods[] = {
478 DEVMETHOD(device_probe, uhso_probe),
479 DEVMETHOD(device_attach, uhso_attach),
480 DEVMETHOD(device_detach, uhso_detach),
484 static driver_t uhso_driver = {
487 sizeof(struct uhso_softc)
490 static devclass_t uhso_devclass;
491 DRIVER_MODULE(uhso, uhub, uhso_driver, uhso_devclass, uhso_driver_loaded, 0);
492 MODULE_DEPEND(uhso, ucom, 1, 1, 1);
493 MODULE_DEPEND(uhso, usb, 1, 1, 1);
494 MODULE_VERSION(uhso, 1);
496 static struct ucom_callback uhso_ucom_callback = {
497 .ucom_cfg_get_status = &uhso_ucom_cfg_get_status,
498 .ucom_cfg_set_dtr = &uhso_ucom_cfg_set_dtr,
499 .ucom_cfg_set_rts = &uhso_ucom_cfg_set_rts,
500 .ucom_start_read = uhso_ucom_start_read,
501 .ucom_stop_read = uhso_ucom_stop_read,
502 .ucom_start_write = uhso_ucom_start_write,
503 .ucom_stop_write = uhso_ucom_stop_write
507 uhso_probe(device_t self)
509 struct usb_attach_arg *uaa = device_get_ivars(self);
512 if (uaa->usb_mode != USB_MODE_HOST)
514 if (uaa->info.bConfigIndex != 0)
516 if (uaa->info.bDeviceClass != 0xff)
519 error = usbd_lookup_id_by_uaa(uhso_devs, sizeof(uhso_devs), uaa);
524 * Probe device to see if we are able to attach
525 * to this interface or not.
527 if (USB_GET_DRIVER_INFO(uaa) == UHSO_AUTO_IFACE) {
528 if (uhso_probe_iface_auto(uaa->device,
529 uaa->info.bIfaceNum) == 0)
536 uhso_attach(device_t self)
538 struct uhso_softc *sc = device_get_softc(self);
539 struct usb_attach_arg *uaa = device_get_ivars(self);
540 struct usb_config_descriptor *cd;
541 struct usb_interface_descriptor *id;
542 struct sysctl_ctx_list *sctx;
543 struct sysctl_oid *soid;
544 struct sysctl_oid *tree = NULL, *tty_node;
545 struct ucom_softc *ucom;
553 sc->sc_udev = uaa->device;
554 mtx_init(&sc->sc_mtx, "uhso", NULL, MTX_DEF);
560 cd = usbd_get_config_descriptor(uaa->device);
561 id = usbd_get_interface_descriptor(uaa->iface);
562 sc->sc_ctrl_iface_no = id->bInterfaceNumber;
564 sc->sc_iface_no = uaa->info.bIfaceNum;
565 sc->sc_iface_index = uaa->info.bIfaceIndex;
567 /* Setup control pipe */
568 uerr = usbd_transfer_setup(uaa->device,
569 &sc->sc_iface_index, sc->sc_ctrl_xfer,
570 uhso_ctrl_config, UHSO_CTRL_MAX, sc, &sc->sc_mtx);
572 device_printf(self, "Failed to setup control pipe: %s\n",
577 if (USB_GET_DRIVER_INFO(uaa) == UHSO_STATIC_IFACE)
578 probe_f = uhso_probe_iface_static;
579 else if (USB_GET_DRIVER_INFO(uaa) == UHSO_AUTO_IFACE)
580 probe_f = uhso_probe_iface_auto;
584 error = uhso_probe_iface(sc, uaa->info.bIfaceNum, probe_f);
588 sctx = device_get_sysctl_ctx(sc->sc_dev);
589 soid = device_get_sysctl_tree(sc->sc_dev);
591 SYSCTL_ADD_STRING(sctx, SYSCTL_CHILDREN(soid), OID_AUTO, "type",
592 CTLFLAG_RD, uhso_port[UHSO_IFACE_PORT(sc->sc_type)], 0,
593 "Port available at this interface");
594 SYSCTL_ADD_PROC(sctx, SYSCTL_CHILDREN(soid), OID_AUTO, "radio",
595 CTLTYPE_INT | CTLFLAG_RW, sc, 0, uhso_radio_sysctl, "I", "Enable radio");
598 * The default interface description on most Option devices isn't
599 * very helpful. So we skip device_set_usb_desc and set the
600 * device description manually.
602 device_set_desc_copy(self, uhso_port_type[UHSO_IFACE_PORT_TYPE(sc->sc_type)]);
603 /* Announce device */
604 device_printf(self, "<%s port> at <%s %s> on %s\n",
605 uhso_port_type[UHSO_IFACE_PORT_TYPE(sc->sc_type)],
606 usb_get_manufacturer(uaa->device),
607 usb_get_product(uaa->device),
608 device_get_nameunit(device_get_parent(self)));
610 if (sc->sc_ttys > 0) {
611 SYSCTL_ADD_INT(sctx, SYSCTL_CHILDREN(soid), OID_AUTO, "ports",
612 CTLFLAG_RD, &sc->sc_ttys, 0, "Number of attached serial ports");
614 tree = SYSCTL_ADD_NODE(sctx, SYSCTL_CHILDREN(soid), OID_AUTO,
615 "port", CTLFLAG_RD, NULL, "Serial ports");
619 * Loop through the number of found TTYs and create sysctl
622 for (i = 0; i < sc->sc_ttys; i++) {
624 ucom = &sc->sc_ucom[i];
626 if (UHSO_IFACE_USB_TYPE(sc->sc_type) & UHSO_IF_MUX)
627 port = uhso_mux_port_map[ht->ht_muxport];
629 port = UHSO_IFACE_PORT_TYPE(sc->sc_type);
631 desc = uhso_port_type_sysctl[port];
633 tty_node = SYSCTL_ADD_NODE(sctx, SYSCTL_CHILDREN(tree), OID_AUTO,
634 desc, CTLFLAG_RD, NULL, "");
637 if (sc->sc_ttys == 1)
638 snprintf(ht->ht_name, 32, "cuaU%d", ucom->sc_super->sc_unit);
640 snprintf(ht->ht_name, 32, "cuaU%d.%d",
641 ucom->sc_super->sc_unit, ucom->sc_subunit);
644 desc = uhso_port_type[port];
645 SYSCTL_ADD_STRING(sctx, SYSCTL_CHILDREN(tty_node), OID_AUTO,
646 "tty", CTLFLAG_RD, ht->ht_name, 0, "");
647 SYSCTL_ADD_STRING(sctx, SYSCTL_CHILDREN(tty_node), OID_AUTO,
648 "desc", CTLFLAG_RD, desc, 0, "");
651 device_printf(sc->sc_dev,
652 "\"%s\" port at %s\n", desc, ht->ht_name);
657 uhso_detach(sc->sc_dev);
662 uhso_detach(device_t self)
664 struct uhso_softc *sc = device_get_softc(self);
667 usbd_transfer_unsetup(sc->sc_xfer, 3);
668 usbd_transfer_unsetup(sc->sc_ctrl_xfer, UHSO_CTRL_MAX);
669 if (sc->sc_ttys > 0) {
670 ucom_detach(&sc->sc_super_ucom, sc->sc_ucom);
672 for (i = 0; i < sc->sc_ttys; i++) {
673 if (sc->sc_tty[i].ht_muxport != -1) {
674 usbd_transfer_unsetup(sc->sc_tty[i].ht_xfer,
679 free(sc->sc_tty, M_USBDEV);
680 free(sc->sc_ucom, M_USBDEV);
683 if (sc->sc_ifp != NULL) {
684 callout_drain(&sc->sc_c);
685 free_unr(uhso_ifnet_unit, sc->sc_ifp->if_dunit);
686 mtx_lock(&sc->sc_mtx);
688 bpfdetach(sc->sc_ifp);
689 if_detach(sc->sc_ifp);
691 mtx_unlock(&sc->sc_mtx);
692 usbd_transfer_unsetup(sc->sc_if_xfer, UHSO_IFNET_MAX);
695 mtx_destroy(&sc->sc_mtx);
700 uhso_test_autoinst(void *arg, struct usb_device *udev,
701 struct usb_attach_arg *uaa)
703 struct usb_interface *iface;
704 struct usb_interface_descriptor *id;
706 if (uaa->dev_state != UAA_DEV_READY || !uhso_autoswitch)
709 iface = usbd_get_iface(udev, 0);
713 if (id == NULL || id->bInterfaceClass != UICLASS_MASS)
715 if (usbd_lookup_id_by_uaa(uhso_devs, sizeof(uhso_devs), uaa))
716 return; /* no device match */
718 if (usb_msc_eject(udev, 0, MSC_EJECT_REZERO) == 0) {
719 /* success, mark the udev as disappearing */
720 uaa->dev_state = UAA_DEV_EJECTING;
725 uhso_driver_loaded(struct module *mod, int what, void *arg)
729 /* register our autoinstall handler */
730 uhso_etag = EVENTHANDLER_REGISTER(usb_dev_configured,
731 uhso_test_autoinst, NULL, EVENTHANDLER_PRI_ANY);
732 /* create our unit allocator for inet devs */
733 uhso_ifnet_unit = new_unrhdr(0, INT_MAX, NULL);
736 EVENTHANDLER_DEREGISTER(usb_dev_configured, uhso_etag);
737 delete_unrhdr(uhso_ifnet_unit);
746 * Probe the interface type by querying the device. The elements
747 * of an array indicates the capabilities of a particular interface.
748 * Returns a bit mask with the interface capabilities.
751 uhso_probe_iface_auto(struct usb_device *udev, int index)
753 struct usb_device_request req;
759 req.bmRequestType = UT_READ_VENDOR_DEVICE;
761 USETW(req.wValue, 0);
762 USETW(req.wIndex, 0);
763 USETW(req.wLength, 17);
765 uerr = usbd_do_request_flags(udev, NULL, &req, buf,
766 0, &actlen, USB_MS_HZ);
768 printf("%s: usbd_do_request_flags failed, %s\n",
769 __func__, usbd_errstr(uerr));
773 UHSO_DPRINTF(1, "actlen=%d\n", actlen);
774 UHSO_HEXDUMP(buf, 17);
776 if (index < 0 || index > 16) {
777 UHSO_DPRINTF(0, "Index %d out of range\n", index);
781 UHSO_DPRINTF(1, "index=%d, type=%x[%s]\n", index, buf[index],
782 uhso_port_type[(int)uhso_port_map[(int)buf[index]]]);
784 if (buf[index] >= uhso_port_map_max)
787 port = uhso_port_map[(int)buf[index]];
790 case UHSO_PORT_TYPE_NETWORK:
791 return (UHSO_IFACE_SPEC(UHSO_IF_NET | UHSO_IF_MUX,
792 UHSO_PORT_SERIAL | UHSO_PORT_NETWORK, port));
793 case UHSO_PORT_TYPE_DIAG:
794 case UHSO_PORT_TYPE_DIAG2:
795 case UHSO_PORT_TYPE_CTL:
796 case UHSO_PORT_TYPE_APP:
797 case UHSO_PORT_TYPE_APP2:
798 case UHSO_PORT_TYPE_MODEM:
799 return (UHSO_IFACE_SPEC(UHSO_IF_BULK,
800 UHSO_PORT_SERIAL, port));
801 case UHSO_PORT_TYPE_MSD:
803 case UHSO_PORT_TYPE_UNKNOWN:
812 * Returns the capabilities of interfaces for devices that don't
813 * support the automatic query.
814 * Returns a bit mask with the interface capabilities.
817 uhso_probe_iface_static(struct usb_device *udev, int index)
819 struct usb_config_descriptor *cd;
821 cd = usbd_get_config_descriptor(udev);
822 if (cd->bNumInterface <= 3) {
823 /* Cards with 3 or less interfaces */
826 return UHSO_IFACE_SPEC(UHSO_IF_NET | UHSO_IF_MUX,
827 UHSO_PORT_SERIAL | UHSO_PORT_NETWORK,
828 UHSO_PORT_TYPE_NETWORK);
830 return UHSO_IFACE_SPEC(UHSO_IF_BULK,
831 UHSO_PORT_SERIAL, UHSO_PORT_TYPE_DIAG);
833 return UHSO_IFACE_SPEC(UHSO_IF_BULK,
834 UHSO_PORT_SERIAL, UHSO_PORT_TYPE_MODEM);
837 /* Cards with 4 interfaces */
840 return UHSO_IFACE_SPEC(UHSO_IF_NET | UHSO_IF_MUX,
841 UHSO_PORT_SERIAL | UHSO_PORT_NETWORK,
842 UHSO_PORT_TYPE_NETWORK);
844 return UHSO_IFACE_SPEC(UHSO_IF_BULK,
845 UHSO_PORT_SERIAL, UHSO_PORT_TYPE_DIAG2);
847 return UHSO_IFACE_SPEC(UHSO_IF_BULK,
848 UHSO_PORT_SERIAL, UHSO_PORT_TYPE_MODEM);
850 return UHSO_IFACE_SPEC(UHSO_IF_BULK,
851 UHSO_PORT_SERIAL, UHSO_PORT_TYPE_DIAG);
858 * Probes an interface for its particular capabilities and attaches if
859 * it's a supported interface.
862 uhso_probe_iface(struct uhso_softc *sc, int index,
863 int (*probe)(struct usb_device *, int))
865 struct usb_interface *iface;
868 UHSO_DPRINTF(1, "Probing for interface %d, probe_func=%p\n", index, probe);
870 type = probe(sc->sc_udev, index);
871 UHSO_DPRINTF(1, "Probe result %x\n", type);
876 iface = usbd_get_iface(sc->sc_udev, index);
878 if (UHSO_IFACE_PORT_TYPE(type) == UHSO_PORT_TYPE_NETWORK) {
879 error = uhso_attach_ifnet(sc, iface, type);
881 UHSO_DPRINTF(1, "uhso_attach_ifnet failed");
886 * If there is an additional interrupt endpoint on this
887 * interface then we most likely have a multiplexed serial port
890 if (iface->idesc->bNumEndpoints < 3) {
891 sc->sc_type = UHSO_IFACE_SPEC(
892 UHSO_IFACE_USB_TYPE(type) & ~UHSO_IF_MUX,
893 UHSO_IFACE_PORT(type) & ~UHSO_PORT_SERIAL,
894 UHSO_IFACE_PORT_TYPE(type));
898 UHSO_DPRINTF(1, "Trying to attach mux. serial\n");
899 error = uhso_attach_muxserial(sc, iface, type);
900 if (error == 0 && sc->sc_ttys > 0) {
901 error = ucom_attach(&sc->sc_super_ucom, sc->sc_ucom,
902 sc->sc_ttys, sc, &uhso_ucom_callback, &sc->sc_mtx);
904 device_printf(sc->sc_dev, "ucom_attach failed\n");
907 ucom_set_pnpinfo_usb(&sc->sc_super_ucom, sc->sc_dev);
909 mtx_lock(&sc->sc_mtx);
910 usbd_transfer_start(sc->sc_xfer[UHSO_MUX_ENDPT_INTR]);
911 mtx_unlock(&sc->sc_mtx);
913 } else if ((UHSO_IFACE_USB_TYPE(type) & UHSO_IF_BULK) &&
914 UHSO_IFACE_PORT(type) & UHSO_PORT_SERIAL) {
916 error = uhso_attach_bulkserial(sc, iface, type);
920 error = ucom_attach(&sc->sc_super_ucom, sc->sc_ucom,
921 sc->sc_ttys, sc, &uhso_ucom_callback, &sc->sc_mtx);
923 device_printf(sc->sc_dev, "ucom_attach failed\n");
926 ucom_set_pnpinfo_usb(&sc->sc_super_ucom, sc->sc_dev);
929 UHSO_DPRINTF(0, "Unknown type %x\n", type);
937 uhso_radio_ctrl(struct uhso_softc *sc, int onoff)
939 struct usb_device_request req;
942 req.bmRequestType = UT_VENDOR;
943 req.bRequest = onoff ? 0x82 : 0x81;
944 USETW(req.wValue, 0);
945 USETW(req.wIndex, 0);
946 USETW(req.wLength, 0);
948 uerr = usbd_do_request(sc->sc_udev, NULL, &req, NULL);
950 device_printf(sc->sc_dev, "usbd_do_request_flags failed: %s\n",
958 uhso_radio_sysctl(SYSCTL_HANDLER_ARGS)
960 struct uhso_softc *sc = arg1;
963 radio = sc->sc_radio;
964 error = sysctl_handle_int(oidp, &radio, 0, req);
967 if (radio != sc->sc_radio) {
968 radio = radio != 0 ? 1 : 0;
969 error = uhso_radio_ctrl(sc, radio);
971 sc->sc_radio = radio;
978 * Expands allocated memory to fit an additional TTY.
979 * Two arrays are kept with matching indexes, one for ucom and one
980 * for our private data.
983 uhso_alloc_tty(struct uhso_softc *sc)
987 sc->sc_tty = reallocf(sc->sc_tty, sizeof(struct uhso_tty) * sc->sc_ttys,
988 M_USBDEV, M_WAITOK | M_ZERO);
989 if (sc->sc_tty == NULL)
992 sc->sc_ucom = reallocf(sc->sc_ucom,
993 sizeof(struct ucom_softc) * sc->sc_ttys, M_USBDEV, M_WAITOK | M_ZERO);
994 if (sc->sc_ucom == NULL)
997 sc->sc_tty[sc->sc_ttys - 1].ht_sc = sc;
999 UHSO_DPRINTF(1, "Allocated TTY %d\n", sc->sc_ttys - 1);
1000 return (sc->sc_ttys - 1);
1004 * Attach a multiplexed serial port
1005 * Data is read/written with requests on the default control pipe. An interrupt
1006 * endpoint returns when there is new data to be read.
1009 uhso_attach_muxserial(struct uhso_softc *sc, struct usb_interface *iface,
1012 struct usb_descriptor *desc;
1017 * The class specific interface (type 0x24) descriptor subtype field
1018 * contains a bitmask that specifies which (and how many) ports that
1019 * are available through this multiplexed serial port.
1021 desc = usbd_find_descriptor(sc->sc_udev, NULL,
1022 iface->idesc->bInterfaceNumber, UDESC_CS_INTERFACE, 0xff, 0, 0);
1024 UHSO_DPRINTF(0, "Failed to find UDESC_CS_INTERFACE\n");
1028 UHSO_DPRINTF(1, "Mux port mask %x\n", desc->bDescriptorSubtype);
1029 if (desc->bDescriptorSubtype == 0)
1033 * The bitmask is one octet, loop through the number of
1034 * bits that are set and create a TTY for each.
1036 for (i = 0; i < 8; i++) {
1038 if ((port & desc->bDescriptorSubtype) == port) {
1039 UHSO_DPRINTF(2, "Found mux port %x (%d)\n", port, i);
1040 tty = uhso_alloc_tty(sc);
1043 sc->sc_tty[tty].ht_muxport = i;
1044 uerr = usbd_transfer_setup(sc->sc_udev,
1045 &sc->sc_iface_index, sc->sc_tty[tty].ht_xfer,
1046 uhso_ctrl_config, UHSO_CTRL_MAX, sc, &sc->sc_mtx);
1048 device_printf(sc->sc_dev,
1049 "Failed to setup control pipe: %s\n",
1056 /* Setup the intr. endpoint */
1057 uerr = usbd_transfer_setup(sc->sc_udev,
1058 &iface->idesc->bInterfaceNumber, sc->sc_xfer,
1059 uhso_mux_config, 1, sc, &sc->sc_mtx);
1067 * Interrupt callback for the multiplexed serial port. Indicates
1068 * which serial port has data waiting.
1071 uhso_mux_intr_callback(struct usb_xfer *xfer, usb_error_t error)
1073 struct usb_page_cache *pc;
1074 struct usb_page_search res;
1075 struct uhso_softc *sc = usbd_xfer_softc(xfer);
1076 unsigned int i, mux;
1078 UHSO_DPRINTF(3, "status %d\n", USB_GET_STATE(xfer));
1080 switch (USB_GET_STATE(xfer)) {
1081 case USB_ST_TRANSFERRED:
1083 * The multiplexed port number can be found at the first byte.
1084 * It contains a bit mask, we transform this in to an integer.
1086 pc = usbd_xfer_get_frame(xfer, 0);
1087 usbd_get_page(pc, 0, &res);
1089 i = *((unsigned char *)res.buffer);
1095 UHSO_DPRINTF(3, "mux port %d (%d)\n", mux, i);
1096 if (mux > UHSO_MPORT_TYPE_NOMAX)
1099 /* Issue a read for this serial port */
1101 sc->sc_tty[mux].ht_xfer[UHSO_CTRL_READ],
1103 usbd_transfer_start(sc->sc_tty[mux].ht_xfer[UHSO_CTRL_READ]);
1108 usbd_xfer_set_frame_len(xfer, 0, usbd_xfer_max_len(xfer));
1109 usbd_transfer_submit(xfer);
1112 UHSO_DPRINTF(0, "error: %s\n", usbd_errstr(error));
1113 if (error == USB_ERR_CANCELLED)
1116 usbd_xfer_set_stall(xfer);
1122 uhso_mux_read_callback(struct usb_xfer *xfer, usb_error_t error)
1124 struct uhso_softc *sc = usbd_xfer_softc(xfer);
1125 struct usb_page_cache *pc;
1126 struct usb_device_request req;
1127 struct uhso_tty *ht;
1130 usbd_xfer_status(xfer, &actlen, NULL, NULL, NULL);
1132 UHSO_DPRINTF(3, "status %d\n", USB_GET_STATE(xfer));
1134 ht = usbd_xfer_get_priv(xfer);
1135 UHSO_DPRINTF(3, "ht=%p open=%d\n", ht, ht->ht_open);
1137 switch (USB_GET_STATE(xfer)) {
1138 case USB_ST_TRANSFERRED:
1139 /* Got data, send to ucom */
1140 pc = usbd_xfer_get_frame(xfer, 1);
1141 len = usbd_xfer_frame_len(xfer, 1);
1143 UHSO_DPRINTF(3, "got %d bytes on mux port %d\n", len,
1146 usbd_transfer_start(sc->sc_xfer[UHSO_MUX_ENDPT_INTR]);
1150 /* Deliver data if the TTY is open, discard otherwise */
1152 ucom_put_data(&sc->sc_ucom[ht->ht_muxport], pc, 0, len);
1156 memset(&req, 0, sizeof(struct usb_device_request));
1157 req.bmRequestType = UT_READ_CLASS_INTERFACE;
1158 req.bRequest = UCDC_GET_ENCAPSULATED_RESPONSE;
1159 USETW(req.wValue, 0);
1160 USETW(req.wIndex, ht->ht_muxport);
1161 USETW(req.wLength, 1024);
1163 pc = usbd_xfer_get_frame(xfer, 0);
1164 usbd_copy_in(pc, 0, &req, sizeof(req));
1166 usbd_xfer_set_frame_len(xfer, 0, sizeof(req));
1167 usbd_xfer_set_frame_len(xfer, 1, 1024);
1168 usbd_xfer_set_frames(xfer, 2);
1169 usbd_transfer_submit(xfer);
1172 UHSO_DPRINTF(0, "error: %s\n", usbd_errstr(error));
1173 if (error == USB_ERR_CANCELLED)
1175 usbd_xfer_set_stall(xfer);
1181 uhso_mux_write_callback(struct usb_xfer *xfer, usb_error_t error)
1183 struct uhso_softc *sc = usbd_xfer_softc(xfer);
1184 struct uhso_tty *ht;
1185 struct usb_page_cache *pc;
1186 struct usb_device_request req;
1188 struct usb_page_search res;
1190 usbd_xfer_status(xfer, &actlen, NULL, NULL, NULL);
1192 ht = usbd_xfer_get_priv(xfer);
1193 UHSO_DPRINTF(3, "status=%d, using mux port %d\n",
1194 USB_GET_STATE(xfer), ht->ht_muxport);
1196 switch (USB_GET_STATE(xfer)) {
1197 case USB_ST_TRANSFERRED:
1198 UHSO_DPRINTF(3, "wrote %zd data bytes to muxport %d\n",
1199 actlen - sizeof(struct usb_device_request) ,
1203 pc = usbd_xfer_get_frame(xfer, 1);
1204 if (ucom_get_data(&sc->sc_ucom[ht->ht_muxport], pc,
1207 usbd_get_page(pc, 0, &res);
1209 memset(&req, 0, sizeof(struct usb_device_request));
1210 req.bmRequestType = UT_WRITE_CLASS_INTERFACE;
1211 req.bRequest = UCDC_SEND_ENCAPSULATED_COMMAND;
1212 USETW(req.wValue, 0);
1213 USETW(req.wIndex, ht->ht_muxport);
1214 USETW(req.wLength, actlen);
1216 pc = usbd_xfer_get_frame(xfer, 0);
1217 usbd_copy_in(pc, 0, &req, sizeof(req));
1219 usbd_xfer_set_frame_len(xfer, 0, sizeof(req));
1220 usbd_xfer_set_frame_len(xfer, 1, actlen);
1221 usbd_xfer_set_frames(xfer, 2);
1223 UHSO_DPRINTF(3, "Prepared %d bytes for transmit "
1224 "on muxport %d\n", actlen, ht->ht_muxport);
1226 usbd_transfer_submit(xfer);
1230 UHSO_DPRINTF(0, "error: %s\n", usbd_errstr(error));
1231 if (error == USB_ERR_CANCELLED)
1238 uhso_attach_bulkserial(struct uhso_softc *sc, struct usb_interface *iface,
1244 /* Try attaching RD/WR/INTR first */
1245 uerr = usbd_transfer_setup(sc->sc_udev,
1246 &iface->idesc->bInterfaceNumber, sc->sc_xfer,
1247 uhso_bs_config, UHSO_BULK_ENDPT_MAX, sc, &sc->sc_mtx);
1249 /* Try only RD/WR */
1250 uerr = usbd_transfer_setup(sc->sc_udev,
1251 &iface->idesc->bInterfaceNumber, sc->sc_xfer,
1252 uhso_bs_config, UHSO_BULK_ENDPT_MAX - 1, sc, &sc->sc_mtx);
1255 UHSO_DPRINTF(0, "usbd_transfer_setup failed");
1259 tty = uhso_alloc_tty(sc);
1261 usbd_transfer_unsetup(sc->sc_xfer, UHSO_BULK_ENDPT_MAX);
1265 sc->sc_tty[tty].ht_muxport = -1;
1270 uhso_bs_read_callback(struct usb_xfer *xfer, usb_error_t error)
1272 struct uhso_softc *sc = usbd_xfer_softc(xfer);
1273 struct usb_page_cache *pc;
1276 usbd_xfer_status(xfer, &actlen, NULL, NULL, NULL);
1278 UHSO_DPRINTF(3, "status %d, actlen=%d\n", USB_GET_STATE(xfer), actlen);
1280 switch (USB_GET_STATE(xfer)) {
1281 case USB_ST_TRANSFERRED:
1282 pc = usbd_xfer_get_frame(xfer, 0);
1283 ucom_put_data(&sc->sc_ucom[0], pc, 0, actlen);
1287 usbd_xfer_set_frame_len(xfer, 0, usbd_xfer_max_len(xfer));
1288 usbd_transfer_submit(xfer);
1291 UHSO_DPRINTF(0, "error: %s\n", usbd_errstr(error));
1292 if (error == USB_ERR_CANCELLED)
1294 usbd_xfer_set_stall(xfer);
1300 uhso_bs_write_callback(struct usb_xfer *xfer, usb_error_t error)
1302 struct uhso_softc *sc = usbd_xfer_softc(xfer);
1303 struct usb_page_cache *pc;
1306 usbd_xfer_status(xfer, &actlen, NULL, NULL, NULL);
1308 UHSO_DPRINTF(3, "status %d, actlen=%d\n", USB_GET_STATE(xfer), actlen);
1310 switch (USB_GET_STATE(xfer)) {
1311 case USB_ST_TRANSFERRED:
1314 pc = usbd_xfer_get_frame(xfer, 0);
1315 if (ucom_get_data(&sc->sc_ucom[0], pc, 0, 8192, &actlen)) {
1316 usbd_xfer_set_frame_len(xfer, 0, actlen);
1317 usbd_transfer_submit(xfer);
1322 UHSO_DPRINTF(0, "error: %s\n", usbd_errstr(error));
1323 if (error == USB_ERR_CANCELLED)
1325 usbd_xfer_set_stall(xfer);
1331 uhso_bs_cfg(struct uhso_softc *sc)
1333 struct usb_device_request req;
1336 if (!(UHSO_IFACE_USB_TYPE(sc->sc_type) & UHSO_IF_BULK))
1339 req.bmRequestType = UT_WRITE_CLASS_INTERFACE;
1340 req.bRequest = UCDC_SET_CONTROL_LINE_STATE;
1341 USETW(req.wValue, sc->sc_line);
1342 USETW(req.wIndex, sc->sc_iface_no);
1343 USETW(req.wLength, 0);
1345 uerr = ucom_cfg_do_request(sc->sc_udev, &sc->sc_ucom[0], &req, NULL, 0, 1000);
1347 device_printf(sc->sc_dev, "failed to set ctrl line state to "
1348 "0x%02x: %s\n", sc->sc_line, usbd_errstr(uerr));
1353 uhso_bs_intr_callback(struct usb_xfer *xfer, usb_error_t error)
1355 struct uhso_softc *sc = usbd_xfer_softc(xfer);
1356 struct usb_page_cache *pc;
1358 struct usb_cdc_notification cdc;
1360 usbd_xfer_status(xfer, &actlen, NULL, NULL, NULL);
1361 UHSO_DPRINTF(3, "status %d, actlen=%d\n", USB_GET_STATE(xfer), actlen);
1363 switch (USB_GET_STATE(xfer)) {
1364 case USB_ST_TRANSFERRED:
1365 if (actlen < UCDC_NOTIFICATION_LENGTH) {
1366 UHSO_DPRINTF(0, "UCDC notification too short: %d\n", actlen);
1369 else if (actlen > sizeof(struct usb_cdc_notification)) {
1370 UHSO_DPRINTF(0, "UCDC notification too large: %d\n", actlen);
1371 actlen = sizeof(struct usb_cdc_notification);
1374 pc = usbd_xfer_get_frame(xfer, 0);
1375 usbd_copy_out(pc, 0, &cdc, actlen);
1377 if (UGETW(cdc.wIndex) != sc->sc_iface_no) {
1378 UHSO_DPRINTF(0, "Interface mismatch, got %d expected %d\n",
1379 UGETW(cdc.wIndex), sc->sc_iface_no);
1383 if (cdc.bmRequestType == UCDC_NOTIFICATION &&
1384 cdc.bNotification == UCDC_N_SERIAL_STATE) {
1385 UHSO_DPRINTF(2, "notify = 0x%02x\n", cdc.data[0]);
1389 if (cdc.data[0] & UCDC_N_SERIAL_RI)
1390 sc->sc_msr |= SER_RI;
1391 if (cdc.data[0] & UCDC_N_SERIAL_DSR)
1392 sc->sc_msr |= SER_DSR;
1393 if (cdc.data[0] & UCDC_N_SERIAL_DCD)
1394 sc->sc_msr |= SER_DCD;
1396 ucom_status_change(&sc->sc_ucom[0]);
1401 if (error == USB_ERR_CANCELLED)
1403 usbd_xfer_set_stall(xfer);
1409 uhso_ucom_cfg_get_status(struct ucom_softc *ucom, uint8_t *lsr, uint8_t *msr)
1411 struct uhso_softc *sc = ucom->sc_parent;
1418 uhso_ucom_cfg_set_dtr(struct ucom_softc *ucom, uint8_t onoff)
1420 struct uhso_softc *sc = ucom->sc_parent;
1422 if (!(UHSO_IFACE_USB_TYPE(sc->sc_type) & UHSO_IF_BULK))
1426 sc->sc_line |= UCDC_LINE_DTR;
1428 sc->sc_line &= ~UCDC_LINE_DTR;
1434 uhso_ucom_cfg_set_rts(struct ucom_softc *ucom, uint8_t onoff)
1436 struct uhso_softc *sc = ucom->sc_parent;
1438 if (!(UHSO_IFACE_USB_TYPE(sc->sc_type) & UHSO_IF_BULK))
1442 sc->sc_line |= UCDC_LINE_RTS;
1444 sc->sc_line &= ~UCDC_LINE_RTS;
1450 uhso_ucom_start_read(struct ucom_softc *ucom)
1452 struct uhso_softc *sc = ucom->sc_parent;
1454 UHSO_DPRINTF(3, "unit=%d, subunit=%d\n",
1455 ucom->sc_super->sc_unit, ucom->sc_subunit);
1457 if (UHSO_IFACE_USB_TYPE(sc->sc_type) & UHSO_IF_MUX) {
1458 sc->sc_tty[ucom->sc_subunit].ht_open = 1;
1459 usbd_transfer_start(sc->sc_xfer[UHSO_MUX_ENDPT_INTR]);
1461 else if (UHSO_IFACE_USB_TYPE(sc->sc_type) & UHSO_IF_BULK) {
1462 sc->sc_tty[0].ht_open = 1;
1463 usbd_transfer_start(sc->sc_xfer[UHSO_BULK_ENDPT_READ]);
1464 if (sc->sc_xfer[UHSO_BULK_ENDPT_INTR] != NULL)
1465 usbd_transfer_start(sc->sc_xfer[UHSO_BULK_ENDPT_INTR]);
1470 uhso_ucom_stop_read(struct ucom_softc *ucom)
1473 struct uhso_softc *sc = ucom->sc_parent;
1475 if (UHSO_IFACE_USB_TYPE(sc->sc_type) & UHSO_IF_MUX) {
1476 sc->sc_tty[ucom->sc_subunit].ht_open = 0;
1478 sc->sc_tty[ucom->sc_subunit].ht_xfer[UHSO_CTRL_READ]);
1480 else if (UHSO_IFACE_USB_TYPE(sc->sc_type) & UHSO_IF_BULK) {
1481 sc->sc_tty[0].ht_open = 0;
1482 usbd_transfer_start(sc->sc_xfer[UHSO_BULK_ENDPT_READ]);
1483 if (sc->sc_xfer[UHSO_BULK_ENDPT_INTR] != NULL)
1484 usbd_transfer_stop(sc->sc_xfer[UHSO_BULK_ENDPT_INTR]);
1489 uhso_ucom_start_write(struct ucom_softc *ucom)
1491 struct uhso_softc *sc = ucom->sc_parent;
1493 if (UHSO_IFACE_USB_TYPE(sc->sc_type) & UHSO_IF_MUX) {
1494 UHSO_DPRINTF(3, "local unit %d\n", ucom->sc_subunit);
1496 usbd_transfer_start(sc->sc_xfer[UHSO_MUX_ENDPT_INTR]);
1499 sc->sc_tty[ucom->sc_subunit].ht_xfer[UHSO_CTRL_WRITE],
1500 &sc->sc_tty[ucom->sc_subunit]);
1501 usbd_transfer_start(
1502 sc->sc_tty[ucom->sc_subunit].ht_xfer[UHSO_CTRL_WRITE]);
1505 else if (UHSO_IFACE_USB_TYPE(sc->sc_type) & UHSO_IF_BULK) {
1506 usbd_transfer_start(sc->sc_xfer[UHSO_BULK_ENDPT_WRITE]);
1511 uhso_ucom_stop_write(struct ucom_softc *ucom)
1513 struct uhso_softc *sc = ucom->sc_parent;
1515 if (UHSO_IFACE_USB_TYPE(sc->sc_type) & UHSO_IF_MUX) {
1517 sc->sc_tty[ucom->sc_subunit].ht_xfer[UHSO_CTRL_WRITE]);
1519 else if (UHSO_IFACE_USB_TYPE(sc->sc_type) & UHSO_IF_BULK) {
1520 usbd_transfer_stop(sc->sc_xfer[UHSO_BULK_ENDPT_WRITE]);
1525 uhso_attach_ifnet(struct uhso_softc *sc, struct usb_interface *iface, int type)
1529 struct sysctl_ctx_list *sctx;
1530 struct sysctl_oid *soid;
1531 unsigned int devunit;
1533 uerr = usbd_transfer_setup(sc->sc_udev,
1534 &iface->idesc->bInterfaceNumber, sc->sc_if_xfer,
1535 uhso_ifnet_config, UHSO_IFNET_MAX, sc, &sc->sc_mtx);
1537 UHSO_DPRINTF(0, "usbd_transfer_setup failed: %s\n",
1542 sc->sc_ifp = ifp = if_alloc(IFT_OTHER);
1543 if (sc->sc_ifp == NULL) {
1544 device_printf(sc->sc_dev, "if_alloc() failed\n");
1548 callout_init_mtx(&sc->sc_c, &sc->sc_mtx, 0);
1549 mtx_lock(&sc->sc_mtx);
1550 callout_reset(&sc->sc_c, 1, uhso_if_rxflush, sc);
1551 mtx_unlock(&sc->sc_mtx);
1554 * We create our own unit numbers for ifnet devices because the
1555 * USB interface unit numbers can be at arbitrary positions yielding
1556 * odd looking device names.
1558 devunit = alloc_unr(uhso_ifnet_unit);
1560 if_initname(ifp, device_get_name(sc->sc_dev), devunit);
1561 ifp->if_mtu = UHSO_MAX_MTU;
1562 ifp->if_ioctl = uhso_if_ioctl;
1563 ifp->if_init = uhso_if_init;
1564 ifp->if_start = uhso_if_start;
1565 ifp->if_output = uhso_if_output;
1566 ifp->if_flags = IFF_BROADCAST | IFF_MULTICAST | IFF_NOARP;
1568 IFQ_SET_MAXLEN(&ifp->if_snd, ifqmaxlen);
1569 ifp->if_snd.ifq_drv_maxlen = ifqmaxlen;
1570 IFQ_SET_READY(&ifp->if_snd);
1573 bpfattach(ifp, DLT_RAW, 0);
1575 sctx = device_get_sysctl_ctx(sc->sc_dev);
1576 soid = device_get_sysctl_tree(sc->sc_dev);
1577 /* Unlocked read... */
1578 SYSCTL_ADD_STRING(sctx, SYSCTL_CHILDREN(soid), OID_AUTO, "netif",
1579 CTLFLAG_RD, ifp->if_xname, 0, "Attached network interface");
1585 uhso_ifnet_read_callback(struct usb_xfer *xfer, usb_error_t error)
1587 struct uhso_softc *sc = usbd_xfer_softc(xfer);
1589 struct usb_page_cache *pc;
1592 usbd_xfer_status(xfer, &actlen, NULL, NULL, NULL);
1594 UHSO_DPRINTF(3, "status=%d, actlen=%d\n", USB_GET_STATE(xfer), actlen);
1596 switch (USB_GET_STATE(xfer)) {
1597 case USB_ST_TRANSFERRED:
1598 if (actlen > 0 && (sc->sc_ifp->if_drv_flags & IFF_DRV_RUNNING)) {
1599 pc = usbd_xfer_get_frame(xfer, 0);
1600 m = m_getcl(M_DONTWAIT, MT_DATA, M_PKTHDR);
1601 usbd_copy_out(pc, 0, mtod(m, uint8_t *), actlen);
1602 m->m_pkthdr.len = m->m_len = actlen;
1603 /* Enqueue frame for further processing */
1604 _IF_ENQUEUE(&sc->sc_rxq, m);
1605 if (!callout_pending(&sc->sc_c) ||
1606 !callout_active(&sc->sc_c)) {
1607 callout_schedule(&sc->sc_c, 1);
1613 usbd_xfer_set_frame_len(xfer, 0, usbd_xfer_max_len(xfer));
1614 usbd_transfer_submit(xfer);
1617 UHSO_DPRINTF(0, "error: %s\n", usbd_errstr(error));
1618 if (error == USB_ERR_CANCELLED)
1620 usbd_xfer_set_stall(xfer);
1626 * Deferred RX processing, called with mutex locked.
1628 * Each frame we receive might contain several small ip-packets as well
1629 * as partial ip-packets. We need to separate/assemble them into individual
1630 * packets before sending them to the ip-layer.
1633 uhso_if_rxflush(void *arg)
1635 struct uhso_softc *sc = arg;
1636 struct ifnet *ifp = sc->sc_ifp;
1638 struct mbuf *m, *m0, *mwait;
1641 struct ip6_hdr *ip6;
1647 mwait = sc->sc_mwait;
1650 _IF_DEQUEUE(&sc->sc_rxq, m);
1653 UHSO_DPRINTF(3, "dequeue m=%p, len=%d\n", m, m->m_len);
1655 mtx_unlock(&sc->sc_mtx);
1657 /* Do we have a partial packet waiting? */
1658 if (mwait != NULL) {
1662 UHSO_DPRINTF(3, "partial m0=%p(%d), concat w/ m=%p(%d)\n",
1663 m0, m0->m_len, m, m->m_len);
1664 len = m->m_len + m0->m_len;
1666 /* Concat mbufs and fix headers */
1668 m0->m_pkthdr.len = len;
1669 m->m_flags &= ~M_PKTHDR;
1671 m = m_pullup(m0, sizeof(struct ip));
1674 UHSO_DPRINTF(0, "m_pullup failed\n");
1675 mtx_lock(&sc->sc_mtx);
1678 UHSO_DPRINTF(3, "Constructed mbuf=%p, len=%d\n",
1679 m, m->m_pkthdr.len);
1682 cp = mtod(m, uint8_t *);
1683 ip = (struct ip *)cp;
1685 ip6 = (struct ip6_hdr *)cp;
1688 /* Check for IPv4 */
1689 if (ip->ip_v == IPVERSION) {
1690 iplen = htons(ip->ip_len);
1694 /* Check for IPv6 */
1695 else if ((ip6->ip6_vfc & IPV6_VERSION_MASK) == IPV6_VERSION) {
1696 iplen = htons(ip6->ip6_plen);
1701 UHSO_DPRINTF(0, "got unexpected ip version %d, "
1702 "m=%p, len=%d\n", (*cp & 0xf0) >> 4, m, m->m_len);
1704 UHSO_HEXDUMP(cp, 4);
1707 mtx_lock(&sc->sc_mtx);
1712 UHSO_DPRINTF(0, "Zero IP length\n");
1716 mtx_lock(&sc->sc_mtx);
1720 UHSO_DPRINTF(3, "m=%p, len=%d, cp=%p, iplen=%d\n",
1721 m, m->m_pkthdr.len, cp, iplen);
1725 /* More IP packets in this mbuf */
1726 if (iplen < m->m_pkthdr.len) {
1730 * Allocate a new mbuf for this IP packet and
1731 * copy the IP-packet into it.
1733 m = m_getcl(M_DONTWAIT, MT_DATA, M_PKTHDR);
1734 memcpy(mtod(m, uint8_t *), mtod(m0, uint8_t *), iplen);
1735 m->m_pkthdr.len = m->m_len = iplen;
1737 /* Adjust the size of the original mbuf */
1739 m0 = m_defrag(m0, M_WAIT);
1741 UHSO_DPRINTF(3, "New mbuf=%p, len=%d/%d, m0=%p, "
1742 "m0_len=%d/%d\n", m, m->m_pkthdr.len, m->m_len,
1743 m0, m0->m_pkthdr.len, m0->m_len);
1745 else if (iplen > m->m_pkthdr.len) {
1746 UHSO_DPRINTF(3, "Deferred mbuf=%p, len=%d\n",
1747 m, m->m_pkthdr.len);
1750 mtx_lock(&sc->sc_mtx);
1755 m->m_pkthdr.rcvif = ifp;
1757 /* Dispatch to IP layer */
1758 BPF_MTAP(sc->sc_ifp, m);
1759 M_SETFIB(m, ifp->if_fib);
1760 netisr_dispatch(isr, m);
1761 m = m0 != NULL ? m0 : NULL;
1762 mtx_lock(&sc->sc_mtx);
1764 sc->sc_mwait = mwait;
1768 uhso_ifnet_write_callback(struct usb_xfer *xfer, usb_error_t error)
1770 struct uhso_softc *sc = usbd_xfer_softc(xfer);
1771 struct ifnet *ifp = sc->sc_ifp;
1772 struct usb_page_cache *pc;
1776 usbd_xfer_status(xfer, &actlen, NULL, NULL, NULL);
1778 UHSO_DPRINTF(3, "status %d, actlen=%d\n", USB_GET_STATE(xfer), actlen);
1780 switch (USB_GET_STATE(xfer)) {
1781 case USB_ST_TRANSFERRED:
1783 ifp->if_drv_flags &= ~IFF_DRV_OACTIVE;
1786 IFQ_DRV_DEQUEUE(&ifp->if_snd, m);
1790 ifp->if_drv_flags |= IFF_DRV_OACTIVE;
1792 if (m->m_pkthdr.len > MCLBYTES)
1793 m->m_pkthdr.len = MCLBYTES;
1795 usbd_xfer_set_frame_len(xfer, 0, m->m_pkthdr.len);
1796 pc = usbd_xfer_get_frame(xfer, 0);
1797 usbd_m_copy_in(pc, 0, m, 0, m->m_pkthdr.len);
1798 usbd_transfer_submit(xfer);
1804 UHSO_DPRINTF(0, "error: %s\n", usbd_errstr(error));
1805 if (error == USB_ERR_CANCELLED)
1807 usbd_xfer_set_stall(xfer);
1813 uhso_if_ioctl(struct ifnet *ifp, u_long cmd, caddr_t data)
1815 struct uhso_softc *sc;
1821 if (ifp->if_flags & IFF_UP) {
1822 if (!(ifp->if_drv_flags & IFF_DRV_RUNNING)) {
1827 if (ifp->if_drv_flags & IFF_DRV_RUNNING) {
1828 mtx_lock(&sc->sc_mtx);
1830 mtx_unlock(&sc->sc_mtx);
1835 case SIOCSIFDSTADDR:
1846 uhso_if_init(void *priv)
1848 struct uhso_softc *sc = priv;
1849 struct ifnet *ifp = sc->sc_ifp;
1851 mtx_lock(&sc->sc_mtx);
1854 ifp->if_flags |= IFF_UP;
1855 ifp->if_drv_flags |= IFF_DRV_RUNNING;
1856 mtx_unlock(&sc->sc_mtx);
1858 UHSO_DPRINTF(2, "ifnet initialized\n");
1862 uhso_if_output(struct ifnet *ifp, struct mbuf *m0, struct sockaddr *dst,
1867 /* Only IPv4/6 support */
1868 if (dst->sa_family != AF_INET
1870 && dst->sa_family != AF_INET6
1873 return (EAFNOSUPPORT);
1876 error = (ifp->if_transmit)(ifp, m0);
1886 uhso_if_start(struct ifnet *ifp, struct ifaltq_subque *ifsq)
1888 struct uhso_softc *sc = ifp->if_softc;
1890 ASSERT_ALTQ_SQ_DEFAULT(ifp, ifsq);
1892 if ((ifp->if_drv_flags & IFF_DRV_RUNNING) == 0) {
1893 UHSO_DPRINTF(1, "Not running\n");
1897 mtx_lock(&sc->sc_mtx);
1898 usbd_transfer_start(sc->sc_if_xfer[UHSO_IFNET_READ]);
1899 usbd_transfer_start(sc->sc_if_xfer[UHSO_IFNET_WRITE]);
1900 mtx_unlock(&sc->sc_mtx);
1901 UHSO_DPRINTF(3, "interface started\n");
1905 uhso_if_stop(struct uhso_softc *sc)
1908 usbd_transfer_stop(sc->sc_if_xfer[UHSO_IFNET_READ]);
1909 usbd_transfer_stop(sc->sc_if_xfer[UHSO_IFNET_WRITE]);
1910 sc->sc_ifp->if_drv_flags &= ~(IFF_DRV_RUNNING | IFF_DRV_OACTIVE);