sys/dev/usb/net/uhso.c

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