1 /*-
2 * SPDX-License-Identifier: BSD-2-Clause
3 *
4 * Copyright (c) 2010 Fredrik Lindberg <fli@shapeshifter.se>
5 * All rights reserved.
6 *
7 * Redistribution and use in source and binary forms, with or without
8 * modification, are permitted provided that the following conditions
9 * are met:
10 * 1. Redistributions of source code must retain the above copyright
11 * notice, this list of conditions and the following disclaimer.
12 * 2. Redistributions in binary form must reproduce the above copyright
13 * notice, this list of conditions and the following disclaimer in the
14 * documentation and/or other materials provided with the distribution.
15 *
16 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
17 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
18 * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
19 * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
20 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
21 * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
22 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
23 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
24 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
25 * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
26 *
27 */
28
29 #include <sys/param.h>
30 #include <sys/eventhandler.h>
31 #include <sys/sockio.h>
32 #include <sys/mbuf.h>
33 #include <sys/malloc.h>
34 #include <sys/kernel.h>
35 #include <sys/module.h>
36 #include <sys/socket.h>
37 #include <sys/tty.h>
38 #include <sys/sysctl.h>
39 #include <sys/condvar.h>
40 #include <sys/sx.h>
41 #include <sys/proc.h>
42 #include <sys/conf.h>
43 #include <sys/bus.h>
44 #include <sys/systm.h>
45 #include <sys/limits.h>
46
47 #include <machine/bus.h>
48
49 #include <net/if.h>
50 #include <net/if_var.h>
51 #include <net/if_types.h>
52 #include <net/netisr.h>
53 #include <net/bpf.h>
54 #include <netinet/in.h>
55 #include <netinet/ip.h>
56 #include <netinet/ip6.h>
57
58 #include <dev/usb/usb.h>
59 #include <dev/usb/usbdi.h>
60 #include <dev/usb/usbdi_util.h>
61 #include <dev/usb/usb_cdc.h>
62 #include "usbdevs.h"
63 #define USB_DEBUG_VAR uhso_debug
64 #include <dev/usb/usb_debug.h>
65 #include <dev/usb/usb_process.h>
66 #include <dev/usb/usb_busdma.h>
67 #include <dev/usb/usb_msctest.h>
68
69 #include <dev/usb/serial/usb_serial.h>
70
71 struct uhso_tty {
72 struct uhso_softc *ht_sc;
73 struct usb_xfer *ht_xfer[3];
74 int ht_muxport; /* Mux. port no */
75 int ht_open;
76 char ht_name[32];
77 };
78
79 struct uhso_softc {
80 device_t sc_dev;
81 struct usb_device *sc_udev;
82 struct mtx sc_mtx;
83 uint32_t sc_type; /* Interface definition */
84 int sc_radio;
85
86 struct usb_xfer *sc_xfer[3];
87 uint8_t sc_iface_no;
88 uint8_t sc_iface_index;
89
90 /* Control pipe */
91 struct usb_xfer * sc_ctrl_xfer[2];
92 uint8_t sc_ctrl_iface_no;
93
94 /* Network */
95 struct usb_xfer *sc_if_xfer[2];
96 if_t sc_ifp;
97 struct mbuf *sc_mwait; /* Partial packet */
98 size_t sc_waitlen; /* No. of outstanding bytes */
99 struct mbufq sc_rxq;
100 struct callout sc_c;
101
102 /* TTY related structures */
103 struct ucom_super_softc sc_super_ucom;
104 int sc_ttys;
105 struct uhso_tty *sc_tty;
106 struct ucom_softc *sc_ucom;
107 int sc_msr;
108 int sc_lsr;
109 int sc_line;
110 };
111
112 #define UHSO_MAX_MTU 2048
113
114 /*
115 * There are mainly two type of cards floating around.
116 * The first one has 2,3 or 4 interfaces with a multiplexed serial port
117 * and packet interface on the first interface and bulk serial ports
118 * on the others.
119 * The second type of card has several other interfaces, their purpose
120 * can be detected during run-time.
121 */
122 #define UHSO_IFACE_SPEC(usb_type, port, port_type) \
123 (((usb_type) << 24) | ((port) << 16) | (port_type))
124
125 #define UHSO_IFACE_USB_TYPE(x) ((x >> 24) & 0xff)
126 #define UHSO_IFACE_PORT(x) ((x >> 16) & 0xff)
127 #define UHSO_IFACE_PORT_TYPE(x) (x & 0xff)
128
129 /*
130 * USB interface types
131 */
132 #define UHSO_IF_NET 0x01 /* Network packet interface */
133 #define UHSO_IF_MUX 0x02 /* Multiplexed serial port */
134 #define UHSO_IF_BULK 0x04 /* Bulk interface */
135
136 /*
137 * Port types
138 */
139 #define UHSO_PORT_UNKNOWN 0x00
140 #define UHSO_PORT_SERIAL 0x01 /* Serial port */
141 #define UHSO_PORT_NETWORK 0x02 /* Network packet interface */
142
143 /*
144 * Multiplexed serial port destination sub-port names
145 */
146 #define UHSO_MPORT_TYPE_CTL 0x00 /* Control port */
147 #define UHSO_MPORT_TYPE_APP 0x01 /* Application */
148 #define UHSO_MPORT_TYPE_PCSC 0x02
149 #define UHSO_MPORT_TYPE_GPS 0x03
150 #define UHSO_MPORT_TYPE_APP2 0x04 /* Secondary application */
151 #define UHSO_MPORT_TYPE_MAX UHSO_MPORT_TYPE_APP2
152 #define UHSO_MPORT_TYPE_NOMAX 8 /* Max number of mux ports */
153
154 /*
155 * Port definitions
156 * Note that these definitions are arbitrary and do not match the values
157 * returned by the auto config descriptor.
158 */
159 #define UHSO_PORT_TYPE_UNKNOWN 0x00
160 #define UHSO_PORT_TYPE_CTL 0x01
161 #define UHSO_PORT_TYPE_APP 0x02
162 #define UHSO_PORT_TYPE_APP2 0x03
163 #define UHSO_PORT_TYPE_MODEM 0x04
164 #define UHSO_PORT_TYPE_NETWORK 0x05
165 #define UHSO_PORT_TYPE_DIAG 0x06
166 #define UHSO_PORT_TYPE_DIAG2 0x07
167 #define UHSO_PORT_TYPE_GPS 0x08
168 #define UHSO_PORT_TYPE_GPSCTL 0x09
169 #define UHSO_PORT_TYPE_PCSC 0x0a
170 #define UHSO_PORT_TYPE_MSD 0x0b
171 #define UHSO_PORT_TYPE_VOICE 0x0c
172 #define UHSO_PORT_TYPE_MAX 0x0c
173
174 static eventhandler_tag uhso_etag;
175
176 /* Overall port type */
177 static char *uhso_port[] = {
178 "Unknown",
179 "Serial",
180 "Network",
181 "Network/Serial"
182 };
183
184 /*
185 * Map between interface port type read from device and description type.
186 * The position in this array is a direct map to the auto config
187 * descriptor values.
188 */
189 static unsigned char uhso_port_map[] = {
190 UHSO_PORT_TYPE_UNKNOWN,
191 UHSO_PORT_TYPE_DIAG,
192 UHSO_PORT_TYPE_GPS,
193 UHSO_PORT_TYPE_GPSCTL,
194 UHSO_PORT_TYPE_APP,
195 UHSO_PORT_TYPE_APP2,
196 UHSO_PORT_TYPE_CTL,
197 UHSO_PORT_TYPE_NETWORK,
198 UHSO_PORT_TYPE_MODEM,
199 UHSO_PORT_TYPE_MSD,
200 UHSO_PORT_TYPE_PCSC,
201 UHSO_PORT_TYPE_VOICE
202 };
203 static char uhso_port_map_max = sizeof(uhso_port_map) / sizeof(char);
204
205 static unsigned char uhso_mux_port_map[] = {
206 UHSO_PORT_TYPE_CTL,
207 UHSO_PORT_TYPE_APP,
208 UHSO_PORT_TYPE_PCSC,
209 UHSO_PORT_TYPE_GPS,
210 UHSO_PORT_TYPE_APP2
211 };
212
213 static char *uhso_port_type[] = {
214 "Unknown", /* Not a valid port */
215 "Control",
216 "Application",
217 "Application (Secondary)",
218 "Modem",
219 "Network",
220 "Diagnostic",
221 "Diagnostic (Secondary)",
222 "GPS",
223 "GPS Control",
224 "PC Smartcard",
225 "MSD",
226 "Voice",
227 };
228
229 static char *uhso_port_type_sysctl[] = {
230 "unknown",
231 "control",
232 "application",
233 "application",
234 "modem",
235 "network",
236 "diagnostic",
237 "diagnostic",
238 "gps",
239 "gps_control",
240 "pcsc",
241 "msd",
242 "voice",
243 };
244
245 #define UHSO_STATIC_IFACE 0x01
246 #define UHSO_AUTO_IFACE 0x02
247
248 /* ifnet device unit allocations */
249 static struct unrhdr *uhso_ifnet_unit = NULL;
250
251 static const STRUCT_USB_HOST_ID uhso_devs[] = {
252 #define UHSO_DEV(v,p,i) { USB_VPI(USB_VENDOR_##v, USB_PRODUCT_##v##_##p, i) }
253 /* Option GlobeTrotter MAX 7.2 with upgraded firmware */
254 UHSO_DEV(OPTION, GTMAX72, UHSO_STATIC_IFACE),
255 /* Option GlobeSurfer iCON 7.2 */
256 UHSO_DEV(OPTION, GSICON72, UHSO_STATIC_IFACE),
257 /* Option iCON 225 */
258 UHSO_DEV(OPTION, GTHSDPA, UHSO_STATIC_IFACE),
259 /* Option GlobeSurfer iCON HSUPA */
260 UHSO_DEV(OPTION, GSICONHSUPA, UHSO_STATIC_IFACE),
261 /* Option GlobeTrotter HSUPA */
262 UHSO_DEV(OPTION, GTHSUPA, UHSO_STATIC_IFACE),
263 /* GE40x */
264 UHSO_DEV(OPTION, GE40X, UHSO_AUTO_IFACE),
265 UHSO_DEV(OPTION, GE40X_1, UHSO_AUTO_IFACE),
266 UHSO_DEV(OPTION, GE40X_2, UHSO_AUTO_IFACE),
267 UHSO_DEV(OPTION, GE40X_3, UHSO_AUTO_IFACE),
268 /* Option GlobeSurfer iCON 401 */
269 UHSO_DEV(OPTION, ICON401, UHSO_AUTO_IFACE),
270 /* Option GlobeTrotter Module 382 */
271 UHSO_DEV(OPTION, GMT382, UHSO_AUTO_IFACE),
272 /* Option GTM661W */
273 UHSO_DEV(OPTION, GTM661W, UHSO_AUTO_IFACE),
274 /* Option iCON EDGE */
275 UHSO_DEV(OPTION, ICONEDGE, UHSO_STATIC_IFACE),
276 /* Option Module HSxPA */
277 UHSO_DEV(OPTION, MODHSXPA, UHSO_STATIC_IFACE),
278 /* Option iCON 321 */
279 UHSO_DEV(OPTION, ICON321, UHSO_STATIC_IFACE),
280 /* Option iCON 322 */
281 UHSO_DEV(OPTION, GTICON322, UHSO_STATIC_IFACE),
282 /* Option iCON 505 */
283 UHSO_DEV(OPTION, ICON505, UHSO_AUTO_IFACE),
284 /* Option iCON 452 */
285 UHSO_DEV(OPTION, ICON505, UHSO_AUTO_IFACE),
286 #undef UHSO_DEV
287 };
288
289 static SYSCTL_NODE(_hw_usb, OID_AUTO, uhso, CTLFLAG_RW | CTLFLAG_MPSAFE, 0,
290 "USB uhso");
291 static int uhso_autoswitch = 1;
292 SYSCTL_INT(_hw_usb_uhso, OID_AUTO, auto_switch, CTLFLAG_RWTUN,
293 &uhso_autoswitch, 0, "Automatically switch to modem mode");
294
295 #ifdef USB_DEBUG
296 #ifdef UHSO_DEBUG
297 static int uhso_debug = UHSO_DEBUG;
298 #else
299 static int uhso_debug = -1;
300 #endif
301
302 SYSCTL_INT(_hw_usb_uhso, OID_AUTO, debug, CTLFLAG_RWTUN,
303 &uhso_debug, 0, "Debug level");
304
305 #define UHSO_DPRINTF(n, x, ...) {\
306 if (uhso_debug >= n) {\
307 printf("%s: " x, __func__, ##__VA_ARGS__);\
308 }\
309 }
310 #else
311 #define UHSO_DPRINTF(n, x, ...)
312 #endif
313
314 #ifdef UHSO_DEBUG_HEXDUMP
315 # define UHSO_HEXDUMP(_buf, _len) do { \
316 { \
317 size_t __tmp; \
318 const char *__buf = (const char *)_buf; \
319 for (__tmp = 0; __tmp < _len; __tmp++) \
320 printf("%02hhx ", *__buf++); \
321 printf("\n"); \
322 } \
323 } while(0)
324 #else
325 # define UHSO_HEXDUMP(_buf, _len)
326 #endif
327
328 enum {
329 UHSO_MUX_ENDPT_INTR = 0,
330 UHSO_MUX_ENDPT_MAX
331 };
332
333 enum {
334 UHSO_CTRL_READ = 0,
335 UHSO_CTRL_WRITE,
336 UHSO_CTRL_MAX
337 };
338
339 enum {
340 UHSO_IFNET_READ = 0,
341 UHSO_IFNET_WRITE,
342 UHSO_IFNET_MAX
343 };
344
345 enum {
346 UHSO_BULK_ENDPT_READ = 0,
347 UHSO_BULK_ENDPT_WRITE,
348 UHSO_BULK_ENDPT_INTR,
349 UHSO_BULK_ENDPT_MAX
350 };
351
352 static usb_callback_t uhso_mux_intr_callback;
353 static usb_callback_t uhso_mux_read_callback;
354 static usb_callback_t uhso_mux_write_callback;
355 static usb_callback_t uhso_bs_read_callback;
356 static usb_callback_t uhso_bs_write_callback;
357 static usb_callback_t uhso_bs_intr_callback;
358 static usb_callback_t uhso_ifnet_read_callback;
359 static usb_callback_t uhso_ifnet_write_callback;
360
361 /* Config used for the default control pipes */
362 static const struct usb_config uhso_ctrl_config[UHSO_CTRL_MAX] = {
363 [UHSO_CTRL_READ] = {
364 .type = UE_CONTROL,
365 .endpoint = 0x00,
366 .direction = UE_DIR_ANY,
367 .flags = { .pipe_bof = 1, .short_xfer_ok = 1 },
368 .bufsize = sizeof(struct usb_device_request) + 1024,
369 .callback = &uhso_mux_read_callback
370 },
371
372 [UHSO_CTRL_WRITE] = {
373 .type = UE_CONTROL,
374 .endpoint = 0x00,
375 .direction = UE_DIR_ANY,
376 .flags = { .pipe_bof = 1, .force_short_xfer = 1 },
377 .bufsize = sizeof(struct usb_device_request) + 1024,
378 .timeout = 1000,
379 .callback = &uhso_mux_write_callback
380 }
381 };
382
383 /* Config for the multiplexed serial ports */
384 static const struct usb_config uhso_mux_config[UHSO_MUX_ENDPT_MAX] = {
385 [UHSO_MUX_ENDPT_INTR] = {
386 .type = UE_INTERRUPT,
387 .endpoint = UE_ADDR_ANY,
388 .direction = UE_DIR_IN,
389 .flags = { .short_xfer_ok = 1 },
390 .bufsize = 0,
391 .callback = &uhso_mux_intr_callback,
392 }
393 };
394
395 /* Config for the raw IP-packet interface */
396 static const struct usb_config uhso_ifnet_config[UHSO_IFNET_MAX] = {
397 [UHSO_IFNET_READ] = {
398 .type = UE_BULK,
399 .endpoint = UE_ADDR_ANY,
400 .direction = UE_DIR_IN,
401 .flags = { .pipe_bof = 1, .short_xfer_ok = 1 },
402 .bufsize = MCLBYTES,
403 .callback = &uhso_ifnet_read_callback
404 },
405 [UHSO_IFNET_WRITE] = {
406 .type = UE_BULK,
407 .endpoint = UE_ADDR_ANY,
408 .direction = UE_DIR_OUT,
409 .flags = { .pipe_bof = 1, .force_short_xfer = 1 },
410 .bufsize = MCLBYTES,
411 .timeout = 5 * USB_MS_HZ,
412 .callback = &uhso_ifnet_write_callback
413 }
414 };
415
416 /* Config for interfaces with normal bulk serial ports */
417 static const struct usb_config uhso_bs_config[UHSO_BULK_ENDPT_MAX] = {
418 [UHSO_BULK_ENDPT_READ] = {
419 .type = UE_BULK,
420 .endpoint = UE_ADDR_ANY,
421 .direction = UE_DIR_IN,
422 .flags = { .pipe_bof = 1, .short_xfer_ok = 1 },
423 .bufsize = 4096,
424 .callback = &uhso_bs_read_callback
425 },
426
427 [UHSO_BULK_ENDPT_WRITE] = {
428 .type = UE_BULK,
429 .endpoint = UE_ADDR_ANY,
430 .direction = UE_DIR_OUT,
431 .flags = { .pipe_bof = 1, .force_short_xfer = 1 },
432 .bufsize = 8192,
433 .callback = &uhso_bs_write_callback
434 },
435
436 [UHSO_BULK_ENDPT_INTR] = {
437 .type = UE_INTERRUPT,
438 .endpoint = UE_ADDR_ANY,
439 .direction = UE_DIR_IN,
440 .flags = { .short_xfer_ok = 1 },
441 .bufsize = 0,
442 .callback = &uhso_bs_intr_callback,
443 }
444 };
445
446 static int uhso_probe_iface(struct uhso_softc *, int,
447 int (*probe)(struct usb_device *, int));
448 static int uhso_probe_iface_auto(struct usb_device *, int);
449 static int uhso_probe_iface_static(struct usb_device *, int);
450 static int uhso_attach_muxserial(struct uhso_softc *, struct usb_interface *,
451 int type);
452 static int uhso_attach_bulkserial(struct uhso_softc *, struct usb_interface *,
453 int type);
454 static int uhso_attach_ifnet(struct uhso_softc *, struct usb_interface *,
455 int type);
456 static void uhso_test_autoinst(void *, struct usb_device *,
457 struct usb_attach_arg *);
458 static int uhso_driver_loaded(struct module *, int, void *);
459 static int uhso_radio_sysctl(SYSCTL_HANDLER_ARGS);
460 static int uhso_radio_ctrl(struct uhso_softc *, int);
461
462 static void uhso_free(struct ucom_softc *);
463 static void uhso_ucom_start_read(struct ucom_softc *);
464 static void uhso_ucom_stop_read(struct ucom_softc *);
465 static void uhso_ucom_start_write(struct ucom_softc *);
466 static void uhso_ucom_stop_write(struct ucom_softc *);
467 static void uhso_ucom_cfg_get_status(struct ucom_softc *, uint8_t *, uint8_t *);
468 static void uhso_ucom_cfg_set_dtr(struct ucom_softc *, uint8_t);
469 static void uhso_ucom_cfg_set_rts(struct ucom_softc *, uint8_t);
470 static void uhso_if_init(void *);
471 static void uhso_if_start(if_t);
472 static void uhso_if_stop(struct uhso_softc *);
473 static int uhso_if_ioctl(if_t, u_long, caddr_t);
474 static int uhso_if_output(if_t, struct mbuf *,
475 const struct sockaddr *, struct route *);
476 static void uhso_if_rxflush(void *);
477
478 static device_probe_t uhso_probe;
479 static device_attach_t uhso_attach;
480 static device_detach_t uhso_detach;
481 static void uhso_free_softc(struct uhso_softc *);
482
483 static device_method_t uhso_methods[] = {
484 DEVMETHOD(device_probe, uhso_probe),
485 DEVMETHOD(device_attach, uhso_attach),
486 DEVMETHOD(device_detach, uhso_detach),
487 { 0, 0 }
488 };
489
490 static driver_t uhso_driver = {
491 .name = "uhso",
492 .methods = uhso_methods,
493 .size = sizeof(struct uhso_softc)
494 };
495
496 DRIVER_MODULE(uhso, uhub, uhso_driver, uhso_driver_loaded, NULL);
497 MODULE_DEPEND(uhso, ucom, 1, 1, 1);
498 MODULE_DEPEND(uhso, usb, 1, 1, 1);
499 MODULE_VERSION(uhso, 1);
500 USB_PNP_HOST_INFO(uhso_devs);
501
502 static struct ucom_callback uhso_ucom_callback = {
503 .ucom_cfg_get_status = &uhso_ucom_cfg_get_status,
504 .ucom_cfg_set_dtr = &uhso_ucom_cfg_set_dtr,
505 .ucom_cfg_set_rts = &uhso_ucom_cfg_set_rts,
506 .ucom_start_read = uhso_ucom_start_read,
507 .ucom_stop_read = uhso_ucom_stop_read,
508 .ucom_start_write = uhso_ucom_start_write,
509 .ucom_stop_write = uhso_ucom_stop_write,
510 .ucom_free = &uhso_free,
511 };
512
513 static int
uhso_probe(device_t self)514 uhso_probe(device_t self)
515 {
516 struct usb_attach_arg *uaa = device_get_ivars(self);
517 int error;
518
519 if (uaa->usb_mode != USB_MODE_HOST)
520 return (ENXIO);
521 if (uaa->info.bConfigIndex != 0)
522 return (ENXIO);
523 if (uaa->info.bDeviceClass != 0xff)
524 return (ENXIO);
525
526 error = usbd_lookup_id_by_uaa(uhso_devs, sizeof(uhso_devs), uaa);
527 if (error != 0)
528 return (error);
529
530 /*
531 * Probe device to see if we are able to attach
532 * to this interface or not.
533 */
534 if (USB_GET_DRIVER_INFO(uaa) == UHSO_AUTO_IFACE) {
535 if (uhso_probe_iface_auto(uaa->device,
536 uaa->info.bIfaceNum) == 0)
537 return (ENXIO);
538 }
539 return (error);
540 }
541
542 static int
uhso_attach(device_t self)543 uhso_attach(device_t self)
544 {
545 struct uhso_softc *sc = device_get_softc(self);
546 struct usb_attach_arg *uaa = device_get_ivars(self);
547 struct usb_interface_descriptor *id;
548 struct sysctl_ctx_list *sctx;
549 struct sysctl_oid *soid;
550 struct sysctl_oid *tree = NULL, *tty_node;
551 struct ucom_softc *ucom;
552 struct uhso_tty *ht;
553 int i, error, port;
554 void *probe_f;
555 usb_error_t uerr;
556 char *desc;
557
558 sc->sc_dev = self;
559 sc->sc_udev = uaa->device;
560 mtx_init(&sc->sc_mtx, "uhso", NULL, MTX_DEF);
561 mbufq_init(&sc->sc_rxq, INT_MAX); /* XXXGL: sane maximum */
562 ucom_ref(&sc->sc_super_ucom);
563
564 sc->sc_radio = 1;
565
566 id = usbd_get_interface_descriptor(uaa->iface);
567 sc->sc_ctrl_iface_no = id->bInterfaceNumber;
568
569 sc->sc_iface_no = uaa->info.bIfaceNum;
570 sc->sc_iface_index = uaa->info.bIfaceIndex;
571
572 /* Setup control pipe */
573 uerr = usbd_transfer_setup(uaa->device,
574 &sc->sc_iface_index, sc->sc_ctrl_xfer,
575 uhso_ctrl_config, UHSO_CTRL_MAX, sc, &sc->sc_mtx);
576 if (uerr) {
577 device_printf(self, "Failed to setup control pipe: %s\n",
578 usbd_errstr(uerr));
579 goto out;
580 }
581
582 if (USB_GET_DRIVER_INFO(uaa) == UHSO_STATIC_IFACE)
583 probe_f = uhso_probe_iface_static;
584 else if (USB_GET_DRIVER_INFO(uaa) == UHSO_AUTO_IFACE)
585 probe_f = uhso_probe_iface_auto;
586 else
587 goto out;
588
589 error = uhso_probe_iface(sc, uaa->info.bIfaceNum, probe_f);
590 if (error != 0)
591 goto out;
592
593 sctx = device_get_sysctl_ctx(sc->sc_dev);
594 soid = device_get_sysctl_tree(sc->sc_dev);
595
596 SYSCTL_ADD_STRING(sctx, SYSCTL_CHILDREN(soid), OID_AUTO, "type",
597 CTLFLAG_RD, uhso_port[UHSO_IFACE_PORT(sc->sc_type)], 0,
598 "Port available at this interface");
599 SYSCTL_ADD_PROC(sctx, SYSCTL_CHILDREN(soid), OID_AUTO, "radio",
600 CTLTYPE_INT | CTLFLAG_RWTUN | CTLFLAG_MPSAFE, sc, 0,
601 uhso_radio_sysctl, "I", "Enable radio");
602
603 /*
604 * The default interface description on most Option devices isn't
605 * very helpful. So we skip device_set_usb_desc and set the
606 * device description manually.
607 */
608 device_set_desc_copy(self, uhso_port_type[UHSO_IFACE_PORT_TYPE(sc->sc_type)]);
609 /* Announce device */
610 device_printf(self, "<%s port> at <%s %s> on %s\n",
611 uhso_port_type[UHSO_IFACE_PORT_TYPE(sc->sc_type)],
612 usb_get_manufacturer(uaa->device),
613 usb_get_product(uaa->device),
614 device_get_nameunit(device_get_parent(self)));
615
616 if (sc->sc_ttys > 0) {
617 SYSCTL_ADD_INT(sctx, SYSCTL_CHILDREN(soid), OID_AUTO, "ports",
618 CTLFLAG_RD, &sc->sc_ttys, 0, "Number of attached serial ports");
619
620 tree = SYSCTL_ADD_NODE(sctx, SYSCTL_CHILDREN(soid), OID_AUTO,
621 "port", CTLFLAG_RD | CTLFLAG_MPSAFE, NULL, "Serial ports");
622 }
623
624 /*
625 * Loop through the number of found TTYs and create sysctl
626 * nodes for them.
627 */
628 for (i = 0; i < sc->sc_ttys; i++) {
629 ht = &sc->sc_tty[i];
630 ucom = &sc->sc_ucom[i];
631
632 if (UHSO_IFACE_USB_TYPE(sc->sc_type) & UHSO_IF_MUX)
633 port = uhso_mux_port_map[ht->ht_muxport];
634 else
635 port = UHSO_IFACE_PORT_TYPE(sc->sc_type);
636
637 desc = uhso_port_type_sysctl[port];
638
639 tty_node = SYSCTL_ADD_NODE(sctx, SYSCTL_CHILDREN(tree), OID_AUTO,
640 desc, CTLFLAG_RD | CTLFLAG_MPSAFE, NULL, "");
641
642 ht->ht_name[0] = 0;
643 if (sc->sc_ttys == 1)
644 snprintf(ht->ht_name, 32, "cuaU%d", ucom->sc_super->sc_unit);
645 else {
646 snprintf(ht->ht_name, 32, "cuaU%d.%d",
647 ucom->sc_super->sc_unit, ucom->sc_subunit);
648 }
649
650 desc = uhso_port_type[port];
651 SYSCTL_ADD_STRING(sctx, SYSCTL_CHILDREN(tty_node), OID_AUTO,
652 "tty", CTLFLAG_RD, ht->ht_name, 0, "");
653 SYSCTL_ADD_STRING(sctx, SYSCTL_CHILDREN(tty_node), OID_AUTO,
654 "desc", CTLFLAG_RD, desc, 0, "");
655
656 if (bootverbose)
657 device_printf(sc->sc_dev,
658 "\"%s\" port at %s\n", desc, ht->ht_name);
659 }
660
661 return (0);
662 out:
663 uhso_detach(sc->sc_dev);
664 return (ENXIO);
665 }
666
667 static int
uhso_detach(device_t self)668 uhso_detach(device_t self)
669 {
670 struct uhso_softc *sc = device_get_softc(self);
671 int i;
672
673 usbd_transfer_unsetup(sc->sc_xfer, 3);
674 usbd_transfer_unsetup(sc->sc_ctrl_xfer, UHSO_CTRL_MAX);
675 if (sc->sc_ttys > 0) {
676 ucom_detach(&sc->sc_super_ucom, sc->sc_ucom);
677
678 for (i = 0; i < sc->sc_ttys; i++) {
679 if (sc->sc_tty[i].ht_muxport != -1) {
680 usbd_transfer_unsetup(sc->sc_tty[i].ht_xfer,
681 UHSO_CTRL_MAX);
682 }
683 }
684 }
685
686 if (sc->sc_ifp != NULL) {
687 callout_drain(&sc->sc_c);
688 free_unr(uhso_ifnet_unit, if_getdunit(sc->sc_ifp));
689 mtx_lock(&sc->sc_mtx);
690 uhso_if_stop(sc);
691 mtx_unlock(&sc->sc_mtx);
692 bpfdetach(sc->sc_ifp);
693 if_detach(sc->sc_ifp);
694 if_free(sc->sc_ifp);
695 usbd_transfer_unsetup(sc->sc_if_xfer, UHSO_IFNET_MAX);
696 }
697
698 device_claim_softc(self);
699
700 uhso_free_softc(sc);
701
702 return (0);
703 }
704
705 UCOM_UNLOAD_DRAIN(uhso);
706
707 static void
uhso_free_softc(struct uhso_softc * sc)708 uhso_free_softc(struct uhso_softc *sc)
709 {
710 if (ucom_unref(&sc->sc_super_ucom)) {
711 free(sc->sc_tty, M_USBDEV);
712 free(sc->sc_ucom, M_USBDEV);
713 mtx_destroy(&sc->sc_mtx);
714 device_free_softc(sc);
715 }
716 }
717
718 static void
uhso_free(struct ucom_softc * ucom)719 uhso_free(struct ucom_softc *ucom)
720 {
721 uhso_free_softc(ucom->sc_parent);
722 }
723
724 static void
uhso_test_autoinst(void * arg,struct usb_device * udev,struct usb_attach_arg * uaa)725 uhso_test_autoinst(void *arg, struct usb_device *udev,
726 struct usb_attach_arg *uaa)
727 {
728 struct usb_interface *iface;
729 struct usb_interface_descriptor *id;
730
731 if (uaa->dev_state != UAA_DEV_READY || !uhso_autoswitch)
732 return;
733
734 iface = usbd_get_iface(udev, 0);
735 if (iface == NULL)
736 return;
737 id = iface->idesc;
738 if (id == NULL || id->bInterfaceClass != UICLASS_MASS)
739 return;
740 if (usbd_lookup_id_by_uaa(uhso_devs, sizeof(uhso_devs), uaa))
741 return; /* no device match */
742
743 if (usb_msc_eject(udev, 0, MSC_EJECT_REZERO) == 0) {
744 /* success, mark the udev as disappearing */
745 uaa->dev_state = UAA_DEV_EJECTING;
746 }
747 }
748
749 static int
uhso_driver_loaded(struct module * mod,int what,void * arg)750 uhso_driver_loaded(struct module *mod, int what, void *arg)
751 {
752 switch (what) {
753 case MOD_LOAD:
754 /* register our autoinstall handler */
755 uhso_etag = EVENTHANDLER_REGISTER(usb_dev_configured,
756 uhso_test_autoinst, NULL, EVENTHANDLER_PRI_ANY);
757 /* create our unit allocator for inet devs */
758 uhso_ifnet_unit = new_unrhdr(0, INT_MAX, NULL);
759 break;
760 case MOD_UNLOAD:
761 EVENTHANDLER_DEREGISTER(usb_dev_configured, uhso_etag);
762 delete_unrhdr(uhso_ifnet_unit);
763 break;
764 default:
765 return (EOPNOTSUPP);
766 }
767 return (0);
768 }
769
770 /*
771 * Probe the interface type by querying the device. The elements
772 * of an array indicates the capabilities of a particular interface.
773 * Returns a bit mask with the interface capabilities.
774 */
775 static int
uhso_probe_iface_auto(struct usb_device * udev,int index)776 uhso_probe_iface_auto(struct usb_device *udev, int index)
777 {
778 struct usb_device_request req;
779 usb_error_t uerr;
780 uint16_t actlen = 0;
781 char port;
782 char buf[17] = {0};
783
784 req.bmRequestType = UT_READ_VENDOR_DEVICE;
785 req.bRequest = 0x86;
786 USETW(req.wValue, 0);
787 USETW(req.wIndex, 0);
788 USETW(req.wLength, 17);
789
790 uerr = usbd_do_request_flags(udev, NULL, &req, buf,
791 0, &actlen, USB_MS_HZ);
792 if (uerr != 0) {
793 printf("%s: usbd_do_request_flags failed, %s\n",
794 __func__, usbd_errstr(uerr));
795 return (0);
796 }
797
798 UHSO_DPRINTF(1, "actlen=%d\n", actlen);
799 UHSO_HEXDUMP(buf, 17);
800
801 if (index < 0 || index > 16) {
802 UHSO_DPRINTF(0, "Index %d out of range\n", index);
803 return (0);
804 }
805
806 UHSO_DPRINTF(1, "index=%d, type=%x[%s]\n", index, buf[index],
807 uhso_port_type[(int)uhso_port_map[(int)buf[index]]]);
808
809 if (buf[index] >= uhso_port_map_max)
810 port = 0;
811 else
812 port = uhso_port_map[(int)buf[index]];
813
814 switch (port) {
815 case UHSO_PORT_TYPE_NETWORK:
816 return (UHSO_IFACE_SPEC(UHSO_IF_NET | UHSO_IF_MUX,
817 UHSO_PORT_SERIAL | UHSO_PORT_NETWORK, port));
818 case UHSO_PORT_TYPE_DIAG:
819 case UHSO_PORT_TYPE_DIAG2:
820 case UHSO_PORT_TYPE_GPS:
821 case UHSO_PORT_TYPE_GPSCTL:
822 case UHSO_PORT_TYPE_CTL:
823 case UHSO_PORT_TYPE_APP:
824 case UHSO_PORT_TYPE_APP2:
825 case UHSO_PORT_TYPE_MODEM:
826 return (UHSO_IFACE_SPEC(UHSO_IF_BULK,
827 UHSO_PORT_SERIAL, port));
828 case UHSO_PORT_TYPE_MSD:
829 return (0);
830 case UHSO_PORT_TYPE_UNKNOWN:
831 default:
832 return (0);
833 }
834
835 return (0);
836 }
837
838 /*
839 * Returns the capabilities of interfaces for devices that don't
840 * support the automatic query.
841 * Returns a bit mask with the interface capabilities.
842 */
843 static int
uhso_probe_iface_static(struct usb_device * udev,int index)844 uhso_probe_iface_static(struct usb_device *udev, int index)
845 {
846 struct usb_config_descriptor *cd;
847
848 cd = usbd_get_config_descriptor(udev);
849 if (cd->bNumInterface <= 3) {
850 /* Cards with 3 or less interfaces */
851 switch (index) {
852 case 0:
853 return UHSO_IFACE_SPEC(UHSO_IF_NET | UHSO_IF_MUX,
854 UHSO_PORT_SERIAL | UHSO_PORT_NETWORK,
855 UHSO_PORT_TYPE_NETWORK);
856 case 1:
857 return UHSO_IFACE_SPEC(UHSO_IF_BULK,
858 UHSO_PORT_SERIAL, UHSO_PORT_TYPE_DIAG);
859 case 2:
860 return UHSO_IFACE_SPEC(UHSO_IF_BULK,
861 UHSO_PORT_SERIAL, UHSO_PORT_TYPE_MODEM);
862 }
863 } else {
864 /* Cards with 4 interfaces */
865 switch (index) {
866 case 0:
867 return UHSO_IFACE_SPEC(UHSO_IF_NET | UHSO_IF_MUX,
868 UHSO_PORT_SERIAL | UHSO_PORT_NETWORK,
869 UHSO_PORT_TYPE_NETWORK);
870 case 1:
871 return UHSO_IFACE_SPEC(UHSO_IF_BULK,
872 UHSO_PORT_SERIAL, UHSO_PORT_TYPE_DIAG2);
873 case 2:
874 return UHSO_IFACE_SPEC(UHSO_IF_BULK,
875 UHSO_PORT_SERIAL, UHSO_PORT_TYPE_MODEM);
876 case 3:
877 return UHSO_IFACE_SPEC(UHSO_IF_BULK,
878 UHSO_PORT_SERIAL, UHSO_PORT_TYPE_DIAG);
879 }
880 }
881 return (0);
882 }
883
884 /*
885 * Probes an interface for its particular capabilities and attaches if
886 * it's a supported interface.
887 */
888 static int
uhso_probe_iface(struct uhso_softc * sc,int index,int (* probe)(struct usb_device *,int))889 uhso_probe_iface(struct uhso_softc *sc, int index,
890 int (*probe)(struct usb_device *, int))
891 {
892 struct usb_interface *iface;
893 int type, error;
894
895 UHSO_DPRINTF(1, "Probing for interface %d, probe_func=%p\n", index, probe);
896
897 type = probe(sc->sc_udev, index);
898 UHSO_DPRINTF(1, "Probe result %x\n", type);
899 if (type <= 0)
900 return (ENXIO);
901
902 sc->sc_type = type;
903 iface = usbd_get_iface(sc->sc_udev, index);
904
905 if (UHSO_IFACE_PORT_TYPE(type) == UHSO_PORT_TYPE_NETWORK) {
906 error = uhso_attach_ifnet(sc, iface, type);
907 if (error) {
908 UHSO_DPRINTF(1, "uhso_attach_ifnet failed");
909 return (ENXIO);
910 }
911
912 /*
913 * If there is an additional interrupt endpoint on this
914 * interface then we most likely have a multiplexed serial port
915 * available.
916 */
917 if (iface->idesc->bNumEndpoints < 3) {
918 sc->sc_type = UHSO_IFACE_SPEC(
919 UHSO_IFACE_USB_TYPE(type) & ~UHSO_IF_MUX,
920 UHSO_IFACE_PORT(type) & ~UHSO_PORT_SERIAL,
921 UHSO_IFACE_PORT_TYPE(type));
922 return (0);
923 }
924
925 UHSO_DPRINTF(1, "Trying to attach mux. serial\n");
926 error = uhso_attach_muxserial(sc, iface, type);
927 if (error == 0 && sc->sc_ttys > 0) {
928 error = ucom_attach(&sc->sc_super_ucom, sc->sc_ucom,
929 sc->sc_ttys, sc, &uhso_ucom_callback, &sc->sc_mtx);
930 if (error) {
931 device_printf(sc->sc_dev, "ucom_attach failed\n");
932 return (ENXIO);
933 }
934 ucom_set_pnpinfo_usb(&sc->sc_super_ucom, sc->sc_dev);
935
936 mtx_lock(&sc->sc_mtx);
937 usbd_transfer_start(sc->sc_xfer[UHSO_MUX_ENDPT_INTR]);
938 mtx_unlock(&sc->sc_mtx);
939 }
940 } else if ((UHSO_IFACE_USB_TYPE(type) & UHSO_IF_BULK) &&
941 UHSO_IFACE_PORT(type) & UHSO_PORT_SERIAL) {
942 error = uhso_attach_bulkserial(sc, iface, type);
943 if (error)
944 return (ENXIO);
945
946 error = ucom_attach(&sc->sc_super_ucom, sc->sc_ucom,
947 sc->sc_ttys, sc, &uhso_ucom_callback, &sc->sc_mtx);
948 if (error) {
949 device_printf(sc->sc_dev, "ucom_attach failed\n");
950 return (ENXIO);
951 }
952 ucom_set_pnpinfo_usb(&sc->sc_super_ucom, sc->sc_dev);
953 }
954 else {
955 UHSO_DPRINTF(0, "Unknown type %x\n", type);
956 return (ENXIO);
957 }
958
959 return (0);
960 }
961
962 static int
uhso_radio_ctrl(struct uhso_softc * sc,int onoff)963 uhso_radio_ctrl(struct uhso_softc *sc, int onoff)
964 {
965 struct usb_device_request req;
966 usb_error_t uerr;
967
968 req.bmRequestType = UT_VENDOR;
969 req.bRequest = onoff ? 0x82 : 0x81;
970 USETW(req.wValue, 0);
971 USETW(req.wIndex, 0);
972 USETW(req.wLength, 0);
973
974 uerr = usbd_do_request(sc->sc_udev, NULL, &req, NULL);
975 if (uerr != 0) {
976 device_printf(sc->sc_dev, "usbd_do_request_flags failed: %s\n",
977 usbd_errstr(uerr));
978 return (-1);
979 }
980 return (onoff);
981 }
982
983 static int
uhso_radio_sysctl(SYSCTL_HANDLER_ARGS)984 uhso_radio_sysctl(SYSCTL_HANDLER_ARGS)
985 {
986 struct uhso_softc *sc = arg1;
987 int error, radio;
988
989 radio = sc->sc_radio;
990 error = sysctl_handle_int(oidp, &radio, 0, req);
991 if (error)
992 return (error);
993 if (radio != sc->sc_radio) {
994 radio = radio != 0 ? 1 : 0;
995 error = uhso_radio_ctrl(sc, radio);
996 if (error != -1)
997 sc->sc_radio = radio;
998
999 }
1000 return (0);
1001 }
1002
1003 /*
1004 * Expands allocated memory to fit an additional TTY.
1005 * Two arrays are kept with matching indexes, one for ucom and one
1006 * for our private data.
1007 */
1008 static int
uhso_alloc_tty(struct uhso_softc * sc)1009 uhso_alloc_tty(struct uhso_softc *sc)
1010 {
1011
1012 sc->sc_ttys++;
1013 sc->sc_tty = reallocf(sc->sc_tty, sizeof(struct uhso_tty) * sc->sc_ttys,
1014 M_USBDEV, M_WAITOK | M_ZERO);
1015 if (sc->sc_tty == NULL)
1016 return (-1);
1017
1018 sc->sc_ucom = reallocf(sc->sc_ucom,
1019 sizeof(struct ucom_softc) * sc->sc_ttys, M_USBDEV, M_WAITOK | M_ZERO);
1020 if (sc->sc_ucom == NULL)
1021 return (-1);
1022
1023 sc->sc_tty[sc->sc_ttys - 1].ht_sc = sc;
1024
1025 UHSO_DPRINTF(1, "Allocated TTY %d\n", sc->sc_ttys - 1);
1026 return (sc->sc_ttys - 1);
1027 }
1028
1029 /*
1030 * Attach a multiplexed serial port
1031 * Data is read/written with requests on the default control pipe. An interrupt
1032 * endpoint returns when there is new data to be read.
1033 */
1034 static int
uhso_attach_muxserial(struct uhso_softc * sc,struct usb_interface * iface,int type)1035 uhso_attach_muxserial(struct uhso_softc *sc, struct usb_interface *iface,
1036 int type)
1037 {
1038 struct usb_descriptor *desc;
1039 int i, port, tty;
1040 usb_error_t uerr;
1041
1042 /*
1043 * The class specific interface (type 0x24) descriptor subtype field
1044 * contains a bitmask that specifies which (and how many) ports that
1045 * are available through this multiplexed serial port.
1046 */
1047 desc = usbd_find_descriptor(sc->sc_udev, NULL,
1048 iface->idesc->bInterfaceNumber, UDESC_CS_INTERFACE, 0xff, 0, 0);
1049 if (desc == NULL) {
1050 UHSO_DPRINTF(0, "Failed to find UDESC_CS_INTERFACE\n");
1051 return (ENXIO);
1052 }
1053
1054 UHSO_DPRINTF(1, "Mux port mask %x\n", desc->bDescriptorSubtype);
1055 if (desc->bDescriptorSubtype == 0)
1056 return (ENXIO);
1057
1058 /*
1059 * The bitmask is one octet, loop through the number of
1060 * bits that are set and create a TTY for each.
1061 */
1062 for (i = 0; i < 8; i++) {
1063 port = (1 << i);
1064 if ((port & desc->bDescriptorSubtype) == port) {
1065 UHSO_DPRINTF(2, "Found mux port %x (%d)\n", port, i);
1066 tty = uhso_alloc_tty(sc);
1067 if (tty < 0)
1068 return (ENOMEM);
1069 sc->sc_tty[tty].ht_muxport = i;
1070 uerr = usbd_transfer_setup(sc->sc_udev,
1071 &sc->sc_iface_index, sc->sc_tty[tty].ht_xfer,
1072 uhso_ctrl_config, UHSO_CTRL_MAX, sc, &sc->sc_mtx);
1073 if (uerr) {
1074 device_printf(sc->sc_dev,
1075 "Failed to setup control pipe: %s\n",
1076 usbd_errstr(uerr));
1077 return (ENXIO);
1078 }
1079 }
1080 }
1081
1082 /* Setup the intr. endpoint */
1083 uerr = usbd_transfer_setup(sc->sc_udev,
1084 &iface->idesc->bInterfaceNumber, sc->sc_xfer,
1085 uhso_mux_config, 1, sc, &sc->sc_mtx);
1086 if (uerr)
1087 return (ENXIO);
1088
1089 return (0);
1090 }
1091
1092 /*
1093 * Interrupt callback for the multiplexed serial port. Indicates
1094 * which serial port has data waiting.
1095 */
1096 static void
uhso_mux_intr_callback(struct usb_xfer * xfer,usb_error_t error)1097 uhso_mux_intr_callback(struct usb_xfer *xfer, usb_error_t error)
1098 {
1099 struct usb_page_cache *pc;
1100 struct usb_page_search res;
1101 struct uhso_softc *sc = usbd_xfer_softc(xfer);
1102 unsigned i, mux;
1103
1104 UHSO_DPRINTF(3, "status %d\n", USB_GET_STATE(xfer));
1105
1106 switch (USB_GET_STATE(xfer)) {
1107 case USB_ST_TRANSFERRED:
1108 /*
1109 * The multiplexed port number can be found at the first byte.
1110 * It contains a bit mask, we transform this in to an integer.
1111 */
1112 pc = usbd_xfer_get_frame(xfer, 0);
1113 usbd_get_page(pc, 0, &res);
1114
1115 i = *((unsigned char *)res.buffer);
1116 mux = 0;
1117 while (i >>= 1) {
1118 mux++;
1119 }
1120
1121 UHSO_DPRINTF(3, "mux port %d (%d)\n", mux, i);
1122 if (mux > UHSO_MPORT_TYPE_NOMAX)
1123 break;
1124
1125 /* Issue a read for this serial port */
1126 usbd_xfer_set_priv(
1127 sc->sc_tty[mux].ht_xfer[UHSO_CTRL_READ],
1128 &sc->sc_tty[mux]);
1129 usbd_transfer_start(sc->sc_tty[mux].ht_xfer[UHSO_CTRL_READ]);
1130
1131 break;
1132 case USB_ST_SETUP:
1133 tr_setup:
1134 usbd_xfer_set_frame_len(xfer, 0, usbd_xfer_max_len(xfer));
1135 usbd_transfer_submit(xfer);
1136 break;
1137 default:
1138 UHSO_DPRINTF(0, "error: %s\n", usbd_errstr(error));
1139 if (error == USB_ERR_CANCELLED)
1140 break;
1141
1142 usbd_xfer_set_stall(xfer);
1143 goto tr_setup;
1144 }
1145 }
1146
1147 static void
uhso_mux_read_callback(struct usb_xfer * xfer,usb_error_t error)1148 uhso_mux_read_callback(struct usb_xfer *xfer, usb_error_t error)
1149 {
1150 struct uhso_softc *sc = usbd_xfer_softc(xfer);
1151 struct usb_page_cache *pc;
1152 struct usb_device_request req;
1153 struct uhso_tty *ht;
1154 int actlen, len;
1155
1156 usbd_xfer_status(xfer, &actlen, NULL, NULL, NULL);
1157
1158 UHSO_DPRINTF(3, "status %d\n", USB_GET_STATE(xfer));
1159
1160 ht = usbd_xfer_get_priv(xfer);
1161 UHSO_DPRINTF(3, "ht=%p open=%d\n", ht, ht->ht_open);
1162
1163 switch (USB_GET_STATE(xfer)) {
1164 case USB_ST_TRANSFERRED:
1165 /* Got data, send to ucom */
1166 pc = usbd_xfer_get_frame(xfer, 1);
1167 len = usbd_xfer_frame_len(xfer, 1);
1168
1169 UHSO_DPRINTF(3, "got %d bytes on mux port %d\n", len,
1170 ht->ht_muxport);
1171 if (len <= 0) {
1172 usbd_transfer_start(sc->sc_xfer[UHSO_MUX_ENDPT_INTR]);
1173 break;
1174 }
1175
1176 /* Deliver data if the TTY is open, discard otherwise */
1177 if (ht->ht_open)
1178 ucom_put_data(&sc->sc_ucom[ht->ht_muxport], pc, 0, len);
1179 /* FALLTHROUGH */
1180 case USB_ST_SETUP:
1181 tr_setup:
1182 memset(&req, 0, sizeof(struct usb_device_request));
1183 req.bmRequestType = UT_READ_CLASS_INTERFACE;
1184 req.bRequest = UCDC_GET_ENCAPSULATED_RESPONSE;
1185 USETW(req.wValue, 0);
1186 USETW(req.wIndex, ht->ht_muxport);
1187 USETW(req.wLength, 1024);
1188
1189 pc = usbd_xfer_get_frame(xfer, 0);
1190 usbd_copy_in(pc, 0, &req, sizeof(req));
1191
1192 usbd_xfer_set_frame_len(xfer, 0, sizeof(req));
1193 usbd_xfer_set_frame_len(xfer, 1, 1024);
1194 usbd_xfer_set_frames(xfer, 2);
1195 usbd_transfer_submit(xfer);
1196 break;
1197 default:
1198 UHSO_DPRINTF(0, "error: %s\n", usbd_errstr(error));
1199 if (error == USB_ERR_CANCELLED)
1200 break;
1201 usbd_xfer_set_stall(xfer);
1202 goto tr_setup;
1203 }
1204 }
1205
1206 static void
uhso_mux_write_callback(struct usb_xfer * xfer,usb_error_t error)1207 uhso_mux_write_callback(struct usb_xfer *xfer, usb_error_t error)
1208 {
1209 struct uhso_softc *sc = usbd_xfer_softc(xfer);
1210 struct uhso_tty *ht;
1211 struct usb_page_cache *pc;
1212 struct usb_device_request req;
1213 int actlen;
1214 struct usb_page_search res;
1215
1216 usbd_xfer_status(xfer, &actlen, NULL, NULL, NULL);
1217
1218 ht = usbd_xfer_get_priv(xfer);
1219 UHSO_DPRINTF(3, "status=%d, using mux port %d\n",
1220 USB_GET_STATE(xfer), ht->ht_muxport);
1221
1222 switch (USB_GET_STATE(xfer)) {
1223 case USB_ST_TRANSFERRED:
1224 UHSO_DPRINTF(3, "wrote %zd data bytes to muxport %d\n",
1225 actlen - sizeof(struct usb_device_request) ,
1226 ht->ht_muxport);
1227 /* FALLTHROUGH */
1228 case USB_ST_SETUP:
1229 tr_setup:
1230 pc = usbd_xfer_get_frame(xfer, 1);
1231 if (ucom_get_data(&sc->sc_ucom[ht->ht_muxport], pc,
1232 0, 32, &actlen)) {
1233 usbd_get_page(pc, 0, &res);
1234
1235 memset(&req, 0, sizeof(struct usb_device_request));
1236 req.bmRequestType = UT_WRITE_CLASS_INTERFACE;
1237 req.bRequest = UCDC_SEND_ENCAPSULATED_COMMAND;
1238 USETW(req.wValue, 0);
1239 USETW(req.wIndex, ht->ht_muxport);
1240 USETW(req.wLength, actlen);
1241
1242 pc = usbd_xfer_get_frame(xfer, 0);
1243 usbd_copy_in(pc, 0, &req, sizeof(req));
1244
1245 usbd_xfer_set_frame_len(xfer, 0, sizeof(req));
1246 usbd_xfer_set_frame_len(xfer, 1, actlen);
1247 usbd_xfer_set_frames(xfer, 2);
1248
1249 UHSO_DPRINTF(3, "Prepared %d bytes for transmit "
1250 "on muxport %d\n", actlen, ht->ht_muxport);
1251
1252 usbd_transfer_submit(xfer);
1253 }
1254 break;
1255 default:
1256 UHSO_DPRINTF(0, "error: %s\n", usbd_errstr(error));
1257 if (error == USB_ERR_CANCELLED)
1258 break;
1259 usbd_xfer_set_stall(xfer);
1260 goto tr_setup;
1261 }
1262 }
1263
1264 static int
uhso_attach_bulkserial(struct uhso_softc * sc,struct usb_interface * iface,int type)1265 uhso_attach_bulkserial(struct uhso_softc *sc, struct usb_interface *iface,
1266 int type)
1267 {
1268 usb_error_t uerr;
1269 int tty;
1270
1271 /* Try attaching RD/WR/INTR first */
1272 uerr = usbd_transfer_setup(sc->sc_udev,
1273 &iface->idesc->bInterfaceNumber, sc->sc_xfer,
1274 uhso_bs_config, UHSO_BULK_ENDPT_MAX, sc, &sc->sc_mtx);
1275 if (uerr) {
1276 /* Try only RD/WR */
1277 uerr = usbd_transfer_setup(sc->sc_udev,
1278 &iface->idesc->bInterfaceNumber, sc->sc_xfer,
1279 uhso_bs_config, UHSO_BULK_ENDPT_MAX - 1, sc, &sc->sc_mtx);
1280 }
1281 if (uerr) {
1282 UHSO_DPRINTF(0, "usbd_transfer_setup failed");
1283 return (-1);
1284 }
1285
1286 tty = uhso_alloc_tty(sc);
1287 if (tty < 0) {
1288 usbd_transfer_unsetup(sc->sc_xfer, UHSO_BULK_ENDPT_MAX);
1289 return (ENOMEM);
1290 }
1291
1292 sc->sc_tty[tty].ht_muxport = -1;
1293 return (0);
1294 }
1295
1296 static void
uhso_bs_read_callback(struct usb_xfer * xfer,usb_error_t error)1297 uhso_bs_read_callback(struct usb_xfer *xfer, usb_error_t error)
1298 {
1299 struct uhso_softc *sc = usbd_xfer_softc(xfer);
1300 struct usb_page_cache *pc;
1301 int actlen;
1302
1303 usbd_xfer_status(xfer, &actlen, NULL, NULL, NULL);
1304
1305 UHSO_DPRINTF(3, "status %d, actlen=%d\n", USB_GET_STATE(xfer), actlen);
1306
1307 switch (USB_GET_STATE(xfer)) {
1308 case USB_ST_TRANSFERRED:
1309 pc = usbd_xfer_get_frame(xfer, 0);
1310 ucom_put_data(&sc->sc_ucom[0], pc, 0, actlen);
1311 /* FALLTHROUGH */
1312 case USB_ST_SETUP:
1313 tr_setup:
1314 usbd_xfer_set_frame_len(xfer, 0, usbd_xfer_max_len(xfer));
1315 usbd_transfer_submit(xfer);
1316 break;
1317 default:
1318 UHSO_DPRINTF(0, "error: %s\n", usbd_errstr(error));
1319 if (error == USB_ERR_CANCELLED)
1320 break;
1321 usbd_xfer_set_stall(xfer);
1322 goto tr_setup;
1323 }
1324 }
1325
1326 static void
uhso_bs_write_callback(struct usb_xfer * xfer,usb_error_t error)1327 uhso_bs_write_callback(struct usb_xfer *xfer, usb_error_t error)
1328 {
1329 struct uhso_softc *sc = usbd_xfer_softc(xfer);
1330 struct usb_page_cache *pc;
1331 int actlen;
1332
1333 usbd_xfer_status(xfer, &actlen, NULL, NULL, NULL);
1334
1335 UHSO_DPRINTF(3, "status %d, actlen=%d\n", USB_GET_STATE(xfer), actlen);
1336
1337 switch (USB_GET_STATE(xfer)) {
1338 case USB_ST_TRANSFERRED:
1339 case USB_ST_SETUP:
1340 tr_setup:
1341 pc = usbd_xfer_get_frame(xfer, 0);
1342 if (ucom_get_data(&sc->sc_ucom[0], pc, 0, 8192, &actlen)) {
1343 usbd_xfer_set_frame_len(xfer, 0, actlen);
1344 usbd_transfer_submit(xfer);
1345 }
1346 break;
1347 break;
1348 default:
1349 UHSO_DPRINTF(0, "error: %s\n", usbd_errstr(error));
1350 if (error == USB_ERR_CANCELLED)
1351 break;
1352 usbd_xfer_set_stall(xfer);
1353 goto tr_setup;
1354 }
1355 }
1356
1357 static void
uhso_bs_cfg(struct uhso_softc * sc)1358 uhso_bs_cfg(struct uhso_softc *sc)
1359 {
1360 struct usb_device_request req;
1361 usb_error_t uerr;
1362
1363 if (!(UHSO_IFACE_USB_TYPE(sc->sc_type) & UHSO_IF_BULK))
1364 return;
1365
1366 req.bmRequestType = UT_WRITE_CLASS_INTERFACE;
1367 req.bRequest = UCDC_SET_CONTROL_LINE_STATE;
1368 USETW(req.wValue, sc->sc_line);
1369 USETW(req.wIndex, sc->sc_iface_no);
1370 USETW(req.wLength, 0);
1371
1372 uerr = ucom_cfg_do_request(sc->sc_udev, &sc->sc_ucom[0], &req, NULL, 0, 1000);
1373 if (uerr != 0) {
1374 device_printf(sc->sc_dev, "failed to set ctrl line state to "
1375 "0x%02x: %s\n", sc->sc_line, usbd_errstr(uerr));
1376 }
1377 }
1378
1379 static void
uhso_bs_intr_callback(struct usb_xfer * xfer,usb_error_t error)1380 uhso_bs_intr_callback(struct usb_xfer *xfer, usb_error_t error)
1381 {
1382 struct uhso_softc *sc = usbd_xfer_softc(xfer);
1383 struct usb_page_cache *pc;
1384 int actlen;
1385 struct usb_cdc_notification cdc;
1386
1387 usbd_xfer_status(xfer, &actlen, NULL, NULL, NULL);
1388 UHSO_DPRINTF(3, "status %d, actlen=%d\n", USB_GET_STATE(xfer), actlen);
1389
1390 switch (USB_GET_STATE(xfer)) {
1391 case USB_ST_TRANSFERRED:
1392 if (actlen < UCDC_NOTIFICATION_LENGTH) {
1393 UHSO_DPRINTF(0, "UCDC notification too short: %d\n", actlen);
1394 goto tr_setup;
1395 }
1396 else if (actlen > (int)sizeof(struct usb_cdc_notification)) {
1397 UHSO_DPRINTF(0, "UCDC notification too large: %d\n", actlen);
1398 actlen = sizeof(struct usb_cdc_notification);
1399 }
1400
1401 pc = usbd_xfer_get_frame(xfer, 0);
1402 usbd_copy_out(pc, 0, &cdc, actlen);
1403
1404 if (UGETW(cdc.wIndex) != sc->sc_iface_no) {
1405 UHSO_DPRINTF(0, "Interface mismatch, got %d expected %d\n",
1406 UGETW(cdc.wIndex), sc->sc_iface_no);
1407 goto tr_setup;
1408 }
1409
1410 if (cdc.bmRequestType == UCDC_NOTIFICATION &&
1411 cdc.bNotification == UCDC_N_SERIAL_STATE) {
1412 UHSO_DPRINTF(2, "notify = 0x%02x\n", cdc.data[0]);
1413
1414 sc->sc_msr = 0;
1415 sc->sc_lsr = 0;
1416 if (cdc.data[0] & UCDC_N_SERIAL_RI)
1417 sc->sc_msr |= SER_RI;
1418 if (cdc.data[0] & UCDC_N_SERIAL_DSR)
1419 sc->sc_msr |= SER_DSR;
1420 if (cdc.data[0] & UCDC_N_SERIAL_DCD)
1421 sc->sc_msr |= SER_DCD;
1422
1423 ucom_status_change(&sc->sc_ucom[0]);
1424 }
1425 case USB_ST_SETUP:
1426 tr_setup:
1427 default:
1428 if (error == USB_ERR_CANCELLED)
1429 break;
1430 usbd_xfer_set_stall(xfer);
1431 goto tr_setup;
1432 }
1433 }
1434
1435 static void
uhso_ucom_cfg_get_status(struct ucom_softc * ucom,uint8_t * lsr,uint8_t * msr)1436 uhso_ucom_cfg_get_status(struct ucom_softc *ucom, uint8_t *lsr, uint8_t *msr)
1437 {
1438 struct uhso_softc *sc = ucom->sc_parent;
1439
1440 *lsr = sc->sc_lsr;
1441 *msr = sc->sc_msr;
1442 }
1443
1444 static void
uhso_ucom_cfg_set_dtr(struct ucom_softc * ucom,uint8_t onoff)1445 uhso_ucom_cfg_set_dtr(struct ucom_softc *ucom, uint8_t onoff)
1446 {
1447 struct uhso_softc *sc = ucom->sc_parent;
1448
1449 if (!(UHSO_IFACE_USB_TYPE(sc->sc_type) & UHSO_IF_BULK))
1450 return;
1451
1452 if (onoff)
1453 sc->sc_line |= UCDC_LINE_DTR;
1454 else
1455 sc->sc_line &= ~UCDC_LINE_DTR;
1456
1457 uhso_bs_cfg(sc);
1458 }
1459
1460 static void
uhso_ucom_cfg_set_rts(struct ucom_softc * ucom,uint8_t onoff)1461 uhso_ucom_cfg_set_rts(struct ucom_softc *ucom, uint8_t onoff)
1462 {
1463 struct uhso_softc *sc = ucom->sc_parent;
1464
1465 if (!(UHSO_IFACE_USB_TYPE(sc->sc_type) & UHSO_IF_BULK))
1466 return;
1467
1468 if (onoff)
1469 sc->sc_line |= UCDC_LINE_RTS;
1470 else
1471 sc->sc_line &= ~UCDC_LINE_RTS;
1472
1473 uhso_bs_cfg(sc);
1474 }
1475
1476 static void
uhso_ucom_start_read(struct ucom_softc * ucom)1477 uhso_ucom_start_read(struct ucom_softc *ucom)
1478 {
1479 struct uhso_softc *sc = ucom->sc_parent;
1480
1481 UHSO_DPRINTF(3, "unit=%d, subunit=%d\n",
1482 ucom->sc_super->sc_unit, ucom->sc_subunit);
1483
1484 if (UHSO_IFACE_USB_TYPE(sc->sc_type) & UHSO_IF_MUX) {
1485 sc->sc_tty[ucom->sc_subunit].ht_open = 1;
1486 usbd_transfer_start(sc->sc_xfer[UHSO_MUX_ENDPT_INTR]);
1487 }
1488 else if (UHSO_IFACE_USB_TYPE(sc->sc_type) & UHSO_IF_BULK) {
1489 sc->sc_tty[0].ht_open = 1;
1490 usbd_transfer_start(sc->sc_xfer[UHSO_BULK_ENDPT_READ]);
1491 if (sc->sc_xfer[UHSO_BULK_ENDPT_INTR] != NULL)
1492 usbd_transfer_start(sc->sc_xfer[UHSO_BULK_ENDPT_INTR]);
1493 }
1494 }
1495
1496 static void
uhso_ucom_stop_read(struct ucom_softc * ucom)1497 uhso_ucom_stop_read(struct ucom_softc *ucom)
1498 {
1499
1500 struct uhso_softc *sc = ucom->sc_parent;
1501
1502 if (UHSO_IFACE_USB_TYPE(sc->sc_type) & UHSO_IF_MUX) {
1503 sc->sc_tty[ucom->sc_subunit].ht_open = 0;
1504 usbd_transfer_stop(
1505 sc->sc_tty[ucom->sc_subunit].ht_xfer[UHSO_CTRL_READ]);
1506 }
1507 else if (UHSO_IFACE_USB_TYPE(sc->sc_type) & UHSO_IF_BULK) {
1508 sc->sc_tty[0].ht_open = 0;
1509 usbd_transfer_start(sc->sc_xfer[UHSO_BULK_ENDPT_READ]);
1510 if (sc->sc_xfer[UHSO_BULK_ENDPT_INTR] != NULL)
1511 usbd_transfer_stop(sc->sc_xfer[UHSO_BULK_ENDPT_INTR]);
1512 }
1513 }
1514
1515 static void
uhso_ucom_start_write(struct ucom_softc * ucom)1516 uhso_ucom_start_write(struct ucom_softc *ucom)
1517 {
1518 struct uhso_softc *sc = ucom->sc_parent;
1519
1520 if (UHSO_IFACE_USB_TYPE(sc->sc_type) & UHSO_IF_MUX) {
1521 UHSO_DPRINTF(3, "local unit %d\n", ucom->sc_subunit);
1522
1523 usbd_transfer_start(sc->sc_xfer[UHSO_MUX_ENDPT_INTR]);
1524
1525 usbd_xfer_set_priv(
1526 sc->sc_tty[ucom->sc_subunit].ht_xfer[UHSO_CTRL_WRITE],
1527 &sc->sc_tty[ucom->sc_subunit]);
1528 usbd_transfer_start(
1529 sc->sc_tty[ucom->sc_subunit].ht_xfer[UHSO_CTRL_WRITE]);
1530 }
1531 else if (UHSO_IFACE_USB_TYPE(sc->sc_type) & UHSO_IF_BULK) {
1532 usbd_transfer_start(sc->sc_xfer[UHSO_BULK_ENDPT_WRITE]);
1533 }
1534 }
1535
1536 static void
uhso_ucom_stop_write(struct ucom_softc * ucom)1537 uhso_ucom_stop_write(struct ucom_softc *ucom)
1538 {
1539 struct uhso_softc *sc = ucom->sc_parent;
1540
1541 if (UHSO_IFACE_USB_TYPE(sc->sc_type) & UHSO_IF_MUX) {
1542 usbd_transfer_stop(
1543 sc->sc_tty[ucom->sc_subunit].ht_xfer[UHSO_CTRL_WRITE]);
1544 }
1545 else if (UHSO_IFACE_USB_TYPE(sc->sc_type) & UHSO_IF_BULK) {
1546 usbd_transfer_stop(sc->sc_xfer[UHSO_BULK_ENDPT_WRITE]);
1547 }
1548 }
1549
1550 static int
uhso_attach_ifnet(struct uhso_softc * sc,struct usb_interface * iface,int type)1551 uhso_attach_ifnet(struct uhso_softc *sc, struct usb_interface *iface, int type)
1552 {
1553 if_t ifp;
1554 usb_error_t uerr;
1555 struct sysctl_ctx_list *sctx;
1556 struct sysctl_oid *soid;
1557 unsigned devunit;
1558
1559 uerr = usbd_transfer_setup(sc->sc_udev,
1560 &iface->idesc->bInterfaceNumber, sc->sc_if_xfer,
1561 uhso_ifnet_config, UHSO_IFNET_MAX, sc, &sc->sc_mtx);
1562 if (uerr) {
1563 UHSO_DPRINTF(0, "usbd_transfer_setup failed: %s\n",
1564 usbd_errstr(uerr));
1565 return (-1);
1566 }
1567
1568 sc->sc_ifp = ifp = if_alloc(IFT_OTHER);
1569
1570 callout_init_mtx(&sc->sc_c, &sc->sc_mtx, 0);
1571 mtx_lock(&sc->sc_mtx);
1572 callout_reset(&sc->sc_c, 1, uhso_if_rxflush, sc);
1573 mtx_unlock(&sc->sc_mtx);
1574
1575 /*
1576 * We create our own unit numbers for ifnet devices because the
1577 * USB interface unit numbers can be at arbitrary positions yielding
1578 * odd looking device names.
1579 */
1580 devunit = alloc_unr(uhso_ifnet_unit);
1581
1582 if_initname(ifp, device_get_name(sc->sc_dev), devunit);
1583 if_setmtu(ifp, UHSO_MAX_MTU);
1584 if_setioctlfn(ifp, uhso_if_ioctl);
1585 if_setinitfn(ifp, uhso_if_init);
1586 if_setstartfn(ifp, uhso_if_start);
1587 if_setoutputfn(ifp, uhso_if_output);
1588 if_setflags(ifp, IFF_BROADCAST | IFF_MULTICAST | IFF_NOARP);
1589 if_setsoftc(ifp, sc);
1590 if_setsendqlen(ifp, ifqmaxlen);
1591 if_setsendqready(ifp);
1592
1593 if_attach(ifp);
1594 bpfattach(ifp, DLT_RAW, 0);
1595
1596 sctx = device_get_sysctl_ctx(sc->sc_dev);
1597 soid = device_get_sysctl_tree(sc->sc_dev);
1598 /* Unlocked read... */
1599 SYSCTL_ADD_CONST_STRING(sctx, SYSCTL_CHILDREN(soid), OID_AUTO, "netif",
1600 CTLFLAG_RD, if_name(ifp), "Attached network interface");
1601
1602 return (0);
1603 }
1604
1605 static void
uhso_ifnet_read_callback(struct usb_xfer * xfer,usb_error_t error)1606 uhso_ifnet_read_callback(struct usb_xfer *xfer, usb_error_t error)
1607 {
1608 struct uhso_softc *sc = usbd_xfer_softc(xfer);
1609 struct mbuf *m;
1610 struct usb_page_cache *pc;
1611 int actlen;
1612
1613 usbd_xfer_status(xfer, &actlen, NULL, NULL, NULL);
1614
1615 UHSO_DPRINTF(3, "status=%d, actlen=%d\n", USB_GET_STATE(xfer), actlen);
1616
1617 switch (USB_GET_STATE(xfer)) {
1618 case USB_ST_TRANSFERRED:
1619 if (actlen > 0 && (if_getdrvflags(sc->sc_ifp) & IFF_DRV_RUNNING)) {
1620 pc = usbd_xfer_get_frame(xfer, 0);
1621 if (mbufq_full(&sc->sc_rxq))
1622 break;
1623 m = m_getcl(M_NOWAIT, MT_DATA, M_PKTHDR);
1624 usbd_copy_out(pc, 0, mtod(m, uint8_t *), actlen);
1625 m->m_pkthdr.len = m->m_len = actlen;
1626 /* Enqueue frame for further processing */
1627 mbufq_enqueue(&sc->sc_rxq, m);
1628 if (!callout_pending(&sc->sc_c) ||
1629 !callout_active(&sc->sc_c)) {
1630 callout_schedule(&sc->sc_c, 1);
1631 }
1632 }
1633 /* FALLTHROUGH */
1634 case USB_ST_SETUP:
1635 tr_setup:
1636 usbd_xfer_set_frame_len(xfer, 0, usbd_xfer_max_len(xfer));
1637 usbd_transfer_submit(xfer);
1638 break;
1639 default:
1640 UHSO_DPRINTF(0, "error: %s\n", usbd_errstr(error));
1641 if (error == USB_ERR_CANCELLED)
1642 break;
1643 usbd_xfer_set_stall(xfer);
1644 goto tr_setup;
1645 }
1646 }
1647
1648 /*
1649 * Deferred RX processing, called with mutex locked.
1650 *
1651 * Each frame we receive might contain several small ip-packets as well
1652 * as partial ip-packets. We need to separate/assemble them into individual
1653 * packets before sending them to the ip-layer.
1654 */
1655 static void
uhso_if_rxflush(void * arg)1656 uhso_if_rxflush(void *arg)
1657 {
1658 struct epoch_tracker et;
1659 struct uhso_softc *sc = arg;
1660 if_t ifp = sc->sc_ifp;
1661 uint8_t *cp;
1662 struct mbuf *m, *m0, *mwait;
1663 struct ip *ip;
1664 #ifdef INET6
1665 struct ip6_hdr *ip6;
1666 #endif
1667 uint16_t iplen;
1668 int isr;
1669
1670 m = NULL;
1671 mwait = sc->sc_mwait;
1672 NET_EPOCH_ENTER(et);
1673 for (;;) {
1674 if (m == NULL) {
1675 if ((m = mbufq_dequeue(&sc->sc_rxq)) == NULL)
1676 break;
1677 UHSO_DPRINTF(3, "dequeue m=%p, len=%d\n", m, m->m_len);
1678 }
1679 mtx_unlock(&sc->sc_mtx);
1680
1681 /* Do we have a partial packet waiting? */
1682 if (mwait != NULL) {
1683 m0 = mwait;
1684 mwait = NULL;
1685
1686 UHSO_DPRINTF(3, "partial m0=%p(%d), concat w/ m=%p(%d)\n",
1687 m0, m0->m_len, m, m->m_len);
1688
1689 m_catpkt(m0, m);
1690 m = m_pullup(m0, sizeof(struct ip));
1691 if (m == NULL) {
1692 if_inc_counter(ifp, IFCOUNTER_IERRORS, 1);
1693 UHSO_DPRINTF(0, "m_pullup failed\n");
1694 mtx_lock(&sc->sc_mtx);
1695 continue;
1696 }
1697 UHSO_DPRINTF(3, "Constructed mbuf=%p, len=%d\n",
1698 m, m->m_pkthdr.len);
1699 }
1700
1701 cp = mtod(m, uint8_t *);
1702 ip = (struct ip *)cp;
1703 #ifdef INET6
1704 ip6 = (struct ip6_hdr *)cp;
1705 #endif
1706
1707 /* Check for IPv4 */
1708 if (ip->ip_v == IPVERSION) {
1709 iplen = htons(ip->ip_len);
1710 isr = NETISR_IP;
1711 }
1712 #ifdef INET6
1713 /* Check for IPv6 */
1714 else if ((ip6->ip6_vfc & IPV6_VERSION_MASK) == IPV6_VERSION) {
1715 iplen = htons(ip6->ip6_plen);
1716 isr = NETISR_IPV6;
1717 }
1718 #endif
1719 else {
1720 UHSO_DPRINTF(0, "got unexpected ip version %d, "
1721 "m=%p, len=%d\n", (*cp & 0xf0) >> 4, m, m->m_len);
1722 if_inc_counter(ifp, IFCOUNTER_IERRORS, 1);
1723 UHSO_HEXDUMP(cp, 4);
1724 m_freem(m);
1725 m = NULL;
1726 mtx_lock(&sc->sc_mtx);
1727 continue;
1728 }
1729
1730 if (iplen == 0) {
1731 UHSO_DPRINTF(0, "Zero IP length\n");
1732 if_inc_counter(ifp, IFCOUNTER_IERRORS, 1);
1733 m_freem(m);
1734 m = NULL;
1735 mtx_lock(&sc->sc_mtx);
1736 continue;
1737 }
1738
1739 UHSO_DPRINTF(3, "m=%p, len=%d, cp=%p, iplen=%d\n",
1740 m, m->m_pkthdr.len, cp, iplen);
1741
1742 m0 = NULL;
1743
1744 /* More IP packets in this mbuf */
1745 if (iplen < m->m_pkthdr.len) {
1746 m0 = m;
1747
1748 /*
1749 * Allocate a new mbuf for this IP packet and
1750 * copy the IP-packet into it.
1751 */
1752 m = m_getcl(M_WAITOK, MT_DATA, M_PKTHDR);
1753 memcpy(mtod(m, uint8_t *), mtod(m0, uint8_t *), iplen);
1754 m->m_pkthdr.len = m->m_len = iplen;
1755
1756 /* Adjust the size of the original mbuf */
1757 m_adj(m0, iplen);
1758 m0 = m_defrag(m0, M_WAITOK);
1759
1760 UHSO_DPRINTF(3, "New mbuf=%p, len=%d/%d, m0=%p, "
1761 "m0_len=%d/%d\n", m, m->m_pkthdr.len, m->m_len,
1762 m0, m0->m_pkthdr.len, m0->m_len);
1763 }
1764 else if (iplen > m->m_pkthdr.len) {
1765 UHSO_DPRINTF(3, "Deferred mbuf=%p, len=%d\n",
1766 m, m->m_pkthdr.len);
1767 mwait = m;
1768 m = NULL;
1769 mtx_lock(&sc->sc_mtx);
1770 continue;
1771 }
1772
1773 if_inc_counter(ifp, IFCOUNTER_IPACKETS, 1);
1774 m->m_pkthdr.rcvif = ifp;
1775
1776 /* Dispatch to IP layer */
1777 BPF_MTAP(sc->sc_ifp, m);
1778 M_SETFIB(m, if_getfib(ifp));
1779 netisr_dispatch(isr, m);
1780 m = m0 != NULL ? m0 : NULL;
1781 mtx_lock(&sc->sc_mtx);
1782 }
1783 NET_EPOCH_EXIT(et);
1784 sc->sc_mwait = mwait;
1785 }
1786
1787 static void
uhso_ifnet_write_callback(struct usb_xfer * xfer,usb_error_t error)1788 uhso_ifnet_write_callback(struct usb_xfer *xfer, usb_error_t error)
1789 {
1790 struct uhso_softc *sc = usbd_xfer_softc(xfer);
1791 if_t ifp = sc->sc_ifp;
1792 struct usb_page_cache *pc;
1793 struct mbuf *m;
1794 int actlen;
1795
1796 usbd_xfer_status(xfer, &actlen, NULL, NULL, NULL);
1797
1798 UHSO_DPRINTF(3, "status %d, actlen=%d\n", USB_GET_STATE(xfer), actlen);
1799
1800 switch (USB_GET_STATE(xfer)) {
1801 case USB_ST_TRANSFERRED:
1802 if_inc_counter(ifp, IFCOUNTER_OPACKETS, 1);
1803 if_setdrvflagbits(ifp, 0, IFF_DRV_OACTIVE);
1804 case USB_ST_SETUP:
1805 tr_setup:
1806 m = if_dequeue(ifp);
1807 if (m == NULL)
1808 break;
1809
1810 if_setdrvflagbits(ifp, IFF_DRV_OACTIVE, 0);
1811
1812 if (m->m_pkthdr.len > MCLBYTES)
1813 m->m_pkthdr.len = MCLBYTES;
1814
1815 usbd_xfer_set_frame_len(xfer, 0, m->m_pkthdr.len);
1816 pc = usbd_xfer_get_frame(xfer, 0);
1817 usbd_m_copy_in(pc, 0, m, 0, m->m_pkthdr.len);
1818 usbd_transfer_submit(xfer);
1819
1820 BPF_MTAP(ifp, m);
1821 m_freem(m);
1822 break;
1823 default:
1824 UHSO_DPRINTF(0, "error: %s\n", usbd_errstr(error));
1825 if (error == USB_ERR_CANCELLED)
1826 break;
1827 usbd_xfer_set_stall(xfer);
1828 goto tr_setup;
1829 }
1830 }
1831
1832 static int
uhso_if_ioctl(if_t ifp,u_long cmd,caddr_t data)1833 uhso_if_ioctl(if_t ifp, u_long cmd, caddr_t data)
1834 {
1835 struct uhso_softc *sc;
1836
1837 sc = if_getsoftc(ifp);
1838
1839 switch (cmd) {
1840 case SIOCSIFFLAGS:
1841 if (if_getflags(ifp) & IFF_UP) {
1842 if (!(if_getdrvflags(ifp) & IFF_DRV_RUNNING)) {
1843 uhso_if_init(sc);
1844 }
1845 }
1846 else {
1847 if (if_getdrvflags(ifp) & IFF_DRV_RUNNING) {
1848 mtx_lock(&sc->sc_mtx);
1849 uhso_if_stop(sc);
1850 mtx_unlock(&sc->sc_mtx);
1851 }
1852 }
1853 break;
1854 case SIOCSIFADDR:
1855 case SIOCADDMULTI:
1856 case SIOCDELMULTI:
1857 break;
1858 default:
1859 return (EINVAL);
1860 }
1861 return (0);
1862 }
1863
1864 static void
uhso_if_init(void * priv)1865 uhso_if_init(void *priv)
1866 {
1867 struct uhso_softc *sc = priv;
1868 if_t ifp = sc->sc_ifp;
1869
1870 mtx_lock(&sc->sc_mtx);
1871 uhso_if_stop(sc);
1872 ifp = sc->sc_ifp;
1873 if_setflagbits(ifp, IFF_UP, 0);
1874 if_setdrvflagbits(ifp, IFF_DRV_RUNNING, 0);
1875 mtx_unlock(&sc->sc_mtx);
1876
1877 UHSO_DPRINTF(2, "ifnet initialized\n");
1878 }
1879
1880 static int
uhso_if_output(if_t ifp,struct mbuf * m0,const struct sockaddr * dst,struct route * ro)1881 uhso_if_output(if_t ifp, struct mbuf *m0, const struct sockaddr *dst,
1882 struct route *ro)
1883 {
1884 int error;
1885
1886 /* Only IPv4/6 support */
1887 if (dst->sa_family != AF_INET
1888 #ifdef INET6
1889 && dst->sa_family != AF_INET6
1890 #endif
1891 ) {
1892 return (EAFNOSUPPORT);
1893 }
1894
1895 error = if_transmit(ifp, m0);
1896 if (error) {
1897 if_inc_counter(ifp, IFCOUNTER_OERRORS, 1);
1898 return (ENOBUFS);
1899 }
1900 if_inc_counter(ifp, IFCOUNTER_OPACKETS, 1);
1901 return (0);
1902 }
1903
1904 static void
uhso_if_start(if_t ifp)1905 uhso_if_start(if_t ifp)
1906 {
1907 struct uhso_softc *sc = if_getsoftc(ifp);
1908
1909 if ((if_getdrvflags(ifp) & IFF_DRV_RUNNING) == 0) {
1910 UHSO_DPRINTF(1, "Not running\n");
1911 return;
1912 }
1913
1914 mtx_lock(&sc->sc_mtx);
1915 usbd_transfer_start(sc->sc_if_xfer[UHSO_IFNET_READ]);
1916 usbd_transfer_start(sc->sc_if_xfer[UHSO_IFNET_WRITE]);
1917 mtx_unlock(&sc->sc_mtx);
1918 UHSO_DPRINTF(3, "interface started\n");
1919 }
1920
1921 static void
uhso_if_stop(struct uhso_softc * sc)1922 uhso_if_stop(struct uhso_softc *sc)
1923 {
1924
1925 usbd_transfer_stop(sc->sc_if_xfer[UHSO_IFNET_READ]);
1926 usbd_transfer_stop(sc->sc_if_xfer[UHSO_IFNET_WRITE]);
1927 if_setdrvflagbits(sc->sc_ifp, 0, (IFF_DRV_RUNNING | IFF_DRV_OACTIVE));
1928 }
1929