Home | History | Annotate | Line # | Download | only in usb
u3g.c revision 1.16.2.1
      1 /*	$NetBSD: u3g.c,v 1.16.2.1 2011/06/06 09:08:42 jruoho Exp $	*/
      2 
      3 /*-
      4  * Copyright (c) 2009 The NetBSD Foundation, Inc.
      5  * All rights reserved.
      6  *
      7  * This code is derived from software contributed to The NetBSD Foundation.
      8  *
      9  * Redistribution and use in source and binary forms, with or without
     10  * modification, are permitted provided that the following conditions
     11  * are met:
     12  * 1. Redistributions of source code must retain the above copyright
     13  *    notice, this list of conditions and the following disclaimer.
     14  * 2. Redistributions in binary form must reproduce the above copyright
     15  *    notice, this list of conditions and the following disclaimer in the
     16  *    documentation and/or other materials provided with the distribution.
     17  *
     18  * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
     19  * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
     20  * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
     21  * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
     22  * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
     23  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
     24  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
     25  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
     26  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
     27  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
     28  * POSSIBILITY OF SUCH DAMAGE.
     29  */
     30 
     31 /*
     32  * Copyright (c) 2008 AnyWi Technologies
     33  *   Author: Andrea Guzzo <aguzzo (at) anywi.com>
     34  *   * based on uark.c 1.1 2006/08/14 08:30:22 jsg *
     35  *   * parts from ubsa.c 183348 2008-09-25 12:00:56Z phk *
     36  *
     37  * Permission to use, copy, modify, and distribute this software for any
     38  * purpose with or without fee is hereby granted, provided that the above
     39  * copyright notice and this permission notice appear in all copies.
     40  *
     41  * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
     42  * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
     43  * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
     44  * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
     45  * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
     46  * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
     47  * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
     48  *
     49  * $FreeBSD$
     50  */
     51 
     52 #include <sys/cdefs.h>
     53 __KERNEL_RCSID(0, "$NetBSD: u3g.c,v 1.16.2.1 2011/06/06 09:08:42 jruoho Exp $");
     54 
     55 #include <sys/param.h>
     56 #include <sys/systm.h>
     57 #include <sys/kernel.h>
     58 #include <sys/malloc.h>
     59 #include <sys/bus.h>
     60 #include <sys/conf.h>
     61 #include <sys/tty.h>
     62 
     63 #include <dev/usb/usb.h>
     64 #include <dev/usb/usbdi.h>
     65 #include <dev/usb/usbdivar.h>
     66 #include <dev/usb/usbdi_util.h>
     67 
     68 #include <dev/usb/ucomvar.h>
     69 
     70 #include "usbdevs.h"
     71 
     72 /*
     73  * We read/write data from/to the device in 4KB chunks to maximise
     74  * performance.
     75  */
     76 #define U3G_BUFF_SIZE	4096
     77 
     78 /*
     79  * Some 3G devices (the Huawei E160/E220 springs to mind here) buffer up
     80  * data internally even when the USB pipes are closed. So on first open,
     81  * we can receive a large chunk of stale data.
     82  *
     83  * This causes a real problem because the default TTYDEF_LFLAG (applied
     84  * on first open) has the ECHO flag set, resulting in all the stale data
     85  * being echoed straight back to the device by the tty(4) layer. Some
     86  * devices (again, the Huawei E160/E220 for example) react to this spew
     87  * by going catatonic.
     88  *
     89  * All this happens before the application gets a chance to disable ECHO.
     90  *
     91  * We work around this by ignoring all data received from the device for
     92  * a period of two seconds, or until the application starts sending data -
     93  * whichever comes first.
     94  */
     95 #define	U3G_PURGE_SECS	2
     96 
     97 /*
     98  * Define bits for the virtual modem control pins.
     99  * The input pin states are reported via the interrupt pipe on some devices.
    100  */
    101 #define	U3G_OUTPIN_DTR	(1u << 0)
    102 #define	U3G_OUTPIN_RTS	(1u << 1)
    103 #define	U3G_INPIN_DCD	(1u << 0)
    104 #define	U3G_INPIN_DSR	(1u << 1)
    105 #define	U3G_INPIN_RI	(1u << 3)
    106 
    107 /*
    108  * USB request to set the output pin status
    109  */
    110 #define	U3G_SET_PIN	0x22
    111 
    112 struct u3g_softc {
    113 	device_t		sc_dev;
    114 	usbd_device_handle	sc_udev;
    115 	bool			sc_dying;	/* We're going away */
    116 
    117 	device_t		sc_ucom;	/* Child ucom(4) handle */
    118 	int			sc_ifaceno;	/* Device interface number */
    119 
    120 	bool			sc_open;	/* Device is in use */
    121 	bool			sc_purging;	/* Purging stale data */
    122 	struct timeval		sc_purge_start;	/* Control duration of purge */
    123 
    124 	u_char			sc_msr;		/* Emulated 'msr' */
    125 	uint16_t		sc_outpins;	/* Output pin state */
    126 
    127 	usbd_pipe_handle	sc_intr_pipe;	/* Interrupt pipe */
    128 	u_char			*sc_intr_buff;	/* Interrupt buffer */
    129 };
    130 
    131 /*
    132  * The device driver has two personalities. The first uses the 'usbdevif'
    133  * interface attribute so that a match will claim the entire USB device
    134  * for itself. This is used for when a device needs to be mode-switched
    135  * and ensures any other interfaces present cannot be claimed by other
    136  * drivers while the mode-switch is in progress.
    137  *
    138  * The second personality uses the 'usbifif' interface attribute so that
    139  * it can claim the 3G modem interfaces for itself, leaving others (such
    140  * as the mass storage interfaces on some devices) for other drivers.
    141  */
    142 static int u3ginit_match(device_t, cfdata_t, void *);
    143 static void u3ginit_attach(device_t, device_t, void *);
    144 static int u3ginit_detach(device_t, int);
    145 
    146 CFATTACH_DECL2_NEW(u3ginit, 0, u3ginit_match,
    147     u3ginit_attach, u3ginit_detach, NULL, NULL, NULL);
    148 
    149 
    150 static int u3g_match(device_t, cfdata_t, void *);
    151 static void u3g_attach(device_t, device_t, void *);
    152 static int u3g_detach(device_t, int);
    153 static int u3g_activate(device_t, enum devact);
    154 static void u3g_childdet(device_t, device_t);
    155 
    156 CFATTACH_DECL2_NEW(u3g, sizeof(struct u3g_softc), u3g_match,
    157     u3g_attach, u3g_detach, u3g_activate, NULL, u3g_childdet);
    158 
    159 
    160 static void u3g_intr(usbd_xfer_handle, usbd_private_handle, usbd_status);
    161 static void u3g_get_status(void *, int, u_char *, u_char *);
    162 static void u3g_set(void *, int, int, int);
    163 static int  u3g_open(void *, int);
    164 static void u3g_close(void *, int);
    165 static void u3g_read(void *, int, u_char **, uint32_t *);
    166 static void u3g_write(void *, int, u_char *, u_char *, u_int32_t *);
    167 
    168 struct ucom_methods u3g_methods = {
    169 	u3g_get_status,
    170 	u3g_set,
    171 	NULL,
    172 	NULL,
    173 	u3g_open,
    174 	u3g_close,
    175 	u3g_read,
    176 	u3g_write,
    177 };
    178 
    179 /*
    180  * Allegedly supported devices
    181  */
    182 static const struct usb_devno u3g_devs[] = {
    183         { USB_VENDOR_DELL, USB_PRODUCT_DELL_W5500 },
    184 	/* OEM: Huawei */
    185 	{ USB_VENDOR_HUAWEI, USB_PRODUCT_HUAWEI_E220 },
    186 	{ USB_VENDOR_HUAWEI, USB_PRODUCT_HUAWEI_K3765 },
    187 	{ USB_VENDOR_HUAWEI, USB_PRODUCT_HUAWEI_MOBILE },
    188 	/* OEM: Merlin */
    189 	{ USB_VENDOR_MERLIN, USB_PRODUCT_MERLIN_V620 },
    190 	/* OEM: Novatel */
    191 	{ USB_VENDOR_NOVATEL2, USB_PRODUCT_NOVATEL2_ES620 },
    192 	{ USB_VENDOR_NOVATEL2, USB_PRODUCT_NOVATEL2_MC950D },
    193 #if 0
    194 	/* These are matched in u3ginit_match() */
    195 	{ USB_VENDOR_NOVATEL2, USB_PRODUCT_NOVATEL2_MC950D_DRIVER },
    196 	{ USB_VENDOR_NOVATEL2, USB_PRODUCT_NOVATEL2_U760_DRIVER },
    197 #endif
    198 	{ USB_VENDOR_NOVATEL2, USB_PRODUCT_NOVATEL2_MERLINU740 },
    199 	{ USB_VENDOR_NOVATEL2, USB_PRODUCT_NOVATEL2_MERLINV620 },
    200 	{ USB_VENDOR_NOVATEL2, USB_PRODUCT_NOVATEL2_S720 },
    201 	{ USB_VENDOR_NOVATEL2, USB_PRODUCT_NOVATEL2_U720 },
    202 	{ USB_VENDOR_NOVATEL2, USB_PRODUCT_NOVATEL2_U727 },
    203 	{ USB_VENDOR_NOVATEL2, USB_PRODUCT_NOVATEL2_U740_2 },
    204 	{ USB_VENDOR_NOVATEL2, USB_PRODUCT_NOVATEL2_U760 },
    205 	{ USB_VENDOR_NOVATEL2, USB_PRODUCT_NOVATEL2_U870 },
    206 	{ USB_VENDOR_NOVATEL2, USB_PRODUCT_NOVATEL2_V740 },
    207 	{ USB_VENDOR_NOVATEL2, USB_PRODUCT_NOVATEL2_X950D },
    208 	{ USB_VENDOR_NOVATEL2, USB_PRODUCT_NOVATEL2_XU870 },
    209 	/* OEM: Option N.V. */
    210 	{ USB_VENDOR_OPTIONNV, USB_PRODUCT_OPTIONNV_QUADPLUSUMTS },
    211 	{ USB_VENDOR_OPTIONNV, USB_PRODUCT_OPTIONNV_HSDPA },
    212 	{ USB_VENDOR_OPTIONNV, USB_PRODUCT_OPTIONNV_GTMAXHSUPA },
    213 	/* OEM: Qualcomm, Inc. */
    214 	{ USB_VENDOR_QUALCOMMINC, USB_PRODUCT_QUALCOMMINC_CDMA_MSM },
    215 	{ USB_VENDOR_QUALCOMMINC, USB_PRODUCT_QUALCOMMINC_ZTE_MF626 },
    216 
    217 	/* OEM: Sierra Wireless: */
    218 	{ USB_VENDOR_SIERRA, USB_PRODUCT_SIERRA_AC595U },
    219 	{ USB_VENDOR_SIERRA, USB_PRODUCT_SIERRA_AC597E },
    220 	{ USB_VENDOR_SIERRA, USB_PRODUCT_SIERRA_AC875U },
    221 	{ USB_VENDOR_SIERRA, USB_PRODUCT_SIERRA_AC880 },
    222 	{ USB_VENDOR_SIERRA, USB_PRODUCT_SIERRA_AC880E },
    223 	{ USB_VENDOR_SIERRA, USB_PRODUCT_SIERRA_AC880U },
    224 	{ USB_VENDOR_SIERRA, USB_PRODUCT_SIERRA_AC881 },
    225 	{ USB_VENDOR_SIERRA, USB_PRODUCT_SIERRA_AC881E },
    226 	{ USB_VENDOR_SIERRA, USB_PRODUCT_SIERRA_AC881U },
    227 	{ USB_VENDOR_SIERRA, USB_PRODUCT_SIERRA_AIRCARD580 },
    228 	{ USB_VENDOR_SIERRA, USB_PRODUCT_SIERRA_AIRCARD595 },
    229 	{ USB_VENDOR_SIERRA, USB_PRODUCT_SIERRA_AIRCARD875 },
    230 	{ USB_VENDOR_SIERRA, USB_PRODUCT_SIERRA_C597 },
    231 	{ USB_VENDOR_SIERRA, USB_PRODUCT_SIERRA_EM5625 },
    232 	{ USB_VENDOR_SIERRA, USB_PRODUCT_SIERRA_MC5720 },
    233 	{ USB_VENDOR_SIERRA, USB_PRODUCT_SIERRA_MC5720_2 },
    234 	{ USB_VENDOR_SIERRA, USB_PRODUCT_SIERRA_MC5725 },
    235 	{ USB_VENDOR_SIERRA, USB_PRODUCT_SIERRA_MC8755 },
    236 	{ USB_VENDOR_SIERRA, USB_PRODUCT_SIERRA_MC8755_2 },
    237 	{ USB_VENDOR_SIERRA, USB_PRODUCT_SIERRA_MC8755_3 },
    238 	{ USB_VENDOR_SIERRA, USB_PRODUCT_SIERRA_MC8765 },
    239 	{ USB_VENDOR_SIERRA, USB_PRODUCT_SIERRA_MC8775_2 },
    240 	{ USB_VENDOR_SIERRA, USB_PRODUCT_SIERRA_MC8780 },
    241 	{ USB_VENDOR_SIERRA, USB_PRODUCT_SIERRA_MC8781 },
    242 	{ USB_VENDOR_SIERRA, USB_PRODUCT_SIERRA_MINI5725 },
    243 	{ USB_VENDOR_SIERRA, USB_PRODUCT_SIERRA_USB305 },
    244 
    245 	/* Toshiba */
    246 	{ USB_VENDOR_TOSHIBA, USB_PRODUCT_TOSHIBA_HSDPA_MODEM_EU870DT1 },
    247 };
    248 
    249 static int
    250 send_bulkmsg(usbd_device_handle dev, char *cmd, size_t cmdlen)
    251 {
    252 	usbd_interface_handle iface;
    253 	usb_interface_descriptor_t *id;
    254 	usb_endpoint_descriptor_t *ed;
    255 	usbd_pipe_handle pipe;
    256 	usbd_xfer_handle xfer;
    257 	int err, i;
    258 
    259 	/* Move the device into the configured state. */
    260 	err = usbd_set_config_index(dev, 0, 0);
    261 	if (err) {
    262 		aprint_error("u3g: failed to set configuration index\n");
    263 		return UMATCH_NONE;
    264 	}
    265 
    266 	err = usbd_device2interface_handle(dev, 0, &iface);
    267 	if (err != 0) {
    268 		aprint_error("u3ginit: failed to get interface\n");
    269 		return UMATCH_NONE;
    270 	}
    271 
    272 	id = usbd_get_interface_descriptor(iface);
    273 	ed = NULL;
    274 	for (i = 0 ; i < id->bNumEndpoints ; i++) {
    275 		ed = usbd_interface2endpoint_descriptor(iface, i);
    276 		if (ed == NULL)
    277 			continue;
    278 		if (UE_GET_DIR(ed->bEndpointAddress) != UE_DIR_OUT)
    279 			continue;
    280 		if ((ed->bmAttributes & UE_XFERTYPE) == UE_BULK)
    281 			break;
    282 	}
    283 
    284 	if (i == id->bNumEndpoints)
    285 		return UMATCH_NONE;
    286 
    287 	err = usbd_open_pipe(iface, ed->bEndpointAddress,
    288 	    USBD_EXCLUSIVE_USE, &pipe);
    289 	if (err != 0) {
    290 		aprint_error("u3ginit: failed to open bulk transfer pipe %d\n",
    291 		    ed->bEndpointAddress);
    292 		return UMATCH_NONE;
    293 	}
    294 
    295 	xfer = usbd_alloc_xfer(dev);
    296 	if (xfer != NULL) {
    297 		usbd_setup_xfer(xfer, pipe, NULL, cmd, cmdlen,
    298 		    USBD_SYNCHRONOUS, USBD_DEFAULT_TIMEOUT, NULL);
    299 
    300 		err = usbd_transfer(xfer);
    301 
    302 #if 0 /* XXXpooka: at least my huawei "fails" this always, but still detaches */
    303 		if (err)
    304 			aprint_error("u3ginit: transfer failed\n");
    305 #else
    306 		err = 0;
    307 #endif
    308 		usbd_free_xfer(xfer);
    309 	} else {
    310 		aprint_error("u3ginit: failed to allocate xfer\n");
    311 		err = USBD_NOMEM;
    312 	}
    313 
    314 	usbd_abort_pipe(pipe);
    315 	usbd_close_pipe(pipe);
    316 
    317 	return (err == USBD_NORMAL_COMPLETION ? UMATCH_HIGHEST : UMATCH_NONE);
    318 }
    319 
    320 static int
    321 u3g_novatel_reinit(usbd_device_handle dev)
    322 {
    323 	unsigned char cmd[31];
    324 
    325 	memset(cmd, 0, sizeof(cmd));
    326 	/* Byte 0..3: Command Block Wrapper (CBW) signature */
    327 	cmd[0] = 0x55;
    328 	cmd[1] = 0x53;
    329 	cmd[2] = 0x42;
    330 	cmd[3] = 0x43;
    331 	/* 4..7: CBW Tag, has to unique, but only a single transfer used. */
    332 	cmd[4] = 0x01;
    333 	/* 8..11: CBW Transfer Length, no data here */
    334 	/* 12: CBW Flag: output, so 0 */
    335 	/* 13: CBW Lun: 0 */
    336 	/* 14: CBW Length */
    337 	cmd[14] = 0x06;
    338 	/* Rest is the SCSI payload */
    339 	/* 0: SCSI START/STOP opcode */
    340 	cmd[15] = 0x1b;
    341 	/* 1..3 unused */
    342 	/* 4 Load/Eject command */
    343 	cmd[19] = 0x02;
    344 	/* 5: unused */
    345 
    346 	return send_bulkmsg(dev, cmd, sizeof(cmd));
    347 }
    348 
    349 static int
    350 u3g_huawei_reinit(usbd_device_handle dev)
    351 {
    352 	/*
    353 	 * The Huawei device presents itself as a umass device with Windows
    354 	 * drivers on it. After installation of the driver, it reinits into a
    355 	 * 3G serial device.
    356 	 */
    357 	usb_device_request_t req;
    358 	usb_config_descriptor_t *cdesc;
    359 
    360 	/* Get the config descriptor */
    361 	cdesc = usbd_get_config_descriptor(dev);
    362 	if (cdesc == NULL) {
    363 		usb_device_descriptor_t dd;
    364 
    365 		if (usbd_get_device_desc(dev, &dd) != 0)
    366 			return (UMATCH_NONE);
    367 
    368 		if (dd.bNumConfigurations != 1)
    369 			return (UMATCH_NONE);
    370 
    371 		if (usbd_set_config_index(dev, 0, 1) != 0)
    372 			return (UMATCH_NONE);
    373 
    374 		cdesc = usbd_get_config_descriptor(dev);
    375 
    376 		if (cdesc == NULL)
    377 			return (UMATCH_NONE);
    378 	}
    379 
    380 	/*
    381 	 * One iface means umass mode, more than 1 (4 usually) means 3G mode.
    382 	 *
    383 	 * XXX: We should check the first interface's device class just to be
    384 	 * sure. If it's a mass storage device, then we can be fairly certain
    385 	 * it needs a mode-switch.
    386 	 */
    387 	if (cdesc->bNumInterface > 1)
    388 		return (UMATCH_NONE);
    389 
    390 	req.bmRequestType = UT_WRITE_DEVICE;
    391 	req.bRequest = UR_SET_FEATURE;
    392 	USETW(req.wValue, UF_DEVICE_REMOTE_WAKEUP);
    393 	USETW(req.wIndex, UHF_PORT_SUSPEND);
    394 	USETW(req.wLength, 0);
    395 
    396 	(void) usbd_do_request(dev, &req, 0);
    397 
    398 	return (UMATCH_HIGHEST); /* Prevent umass from attaching */
    399 }
    400 
    401 static int
    402 u3g_huawei_k3765_reinit(usbd_device_handle dev)
    403 {
    404 	unsigned char cmd[31];
    405 
    406 	/* magic string adapted from some webpage */
    407 	memset(cmd, 0, sizeof(cmd));
    408 	cmd[0] = 0x55;
    409 	cmd[1] = 0x53;
    410 	cmd[2] = 0x42;
    411 	cmd[3] = 0x43;
    412 	cmd[15]= 0x11;
    413 	cmd[16]= 0x06;
    414 
    415 	return send_bulkmsg(dev, cmd, sizeof(cmd));
    416 }
    417 
    418 static int
    419 u3g_sierra_reinit(usbd_device_handle dev)
    420 {
    421 	/* Some Sierra devices presents themselves as a umass device with
    422 	 * Windows drivers on it. After installation of the driver, it
    423 	 * reinits into a * 3G serial device.
    424 	 */
    425 	usb_device_request_t req;
    426 
    427 	req.bmRequestType = UT_VENDOR;
    428 	req.bRequest = UR_SET_INTERFACE;
    429 	USETW(req.wValue, UF_DEVICE_REMOTE_WAKEUP);
    430 	USETW(req.wIndex, UHF_PORT_CONNECTION);
    431 	USETW(req.wLength, 0);
    432 
    433 	(void) usbd_do_request(dev, &req, 0);
    434 
    435 	return (UMATCH_HIGHEST); /* Match to prevent umass from attaching */
    436 }
    437 
    438 /*
    439  * First personality:
    440  *
    441  * Claim the entire device if a mode-switch is required.
    442  */
    443 
    444 static int
    445 u3ginit_match(device_t parent, cfdata_t match, void *aux)
    446 {
    447 	struct usb_attach_arg *uaa = aux;
    448 
    449 	/*
    450 	 * Huawei changes product when it is configured as a modem.
    451 	 */
    452 	switch (uaa->vendor) {
    453 	case USB_VENDOR_HUAWEI:
    454 		if (uaa->product == USB_PRODUCT_HUAWEI_K3765)
    455 			return UMATCH_NONE;
    456 
    457 		switch (uaa->product) {
    458 		case USB_PRODUCT_HUAWEI_E1750INIT:
    459 		case USB_PRODUCT_HUAWEI_K3765INIT:
    460 			return u3g_huawei_k3765_reinit(uaa->device);
    461 			break;
    462 		default:
    463 			return u3g_huawei_reinit(uaa->device);
    464 			break;
    465 		}
    466 		break;
    467 
    468 	case USB_VENDOR_NOVATEL2:
    469 		switch (uaa->product){
    470 		case USB_PRODUCT_NOVATEL2_MC950D_DRIVER:
    471 		case USB_PRODUCT_NOVATEL2_U760_DRIVER:
    472 			return u3g_novatel_reinit(uaa->device);
    473 			break;
    474 		default:
    475 			break;
    476 		}
    477 		break;
    478 
    479 	case USB_VENDOR_SIERRA:
    480 		if (uaa->product == USB_PRODUCT_SIERRA_INSTALLER)
    481 			return u3g_sierra_reinit(uaa->device);
    482 		break;
    483 
    484 	case USB_VENDOR_QUALCOMMINC:
    485 		if (uaa->product == USB_PRODUCT_QUALCOMMINC_ZTE_STOR)
    486 			return u3g_novatel_reinit(uaa->device);
    487 		break;
    488 
    489 	default:
    490 		break;
    491 	}
    492 
    493 	return UMATCH_NONE;
    494 }
    495 
    496 static void
    497 u3ginit_attach(device_t parent, device_t self, void *aux)
    498 {
    499 	struct usb_attach_arg *uaa = aux;
    500 
    501 	aprint_naive("\n");
    502 	aprint_normal(": Switching to 3G mode\n");
    503 
    504 	if (uaa->vendor == USB_VENDOR_NOVATEL2) {
    505 		switch (uaa->product) {
    506 	    	case USB_PRODUCT_NOVATEL2_MC950D_DRIVER:
    507 	    	case USB_PRODUCT_NOVATEL2_U760_DRIVER:
    508 			/* About to disappear... */
    509 			return;
    510 			break;
    511 		default:
    512 			break;
    513 		}
    514 	}
    515 
    516 	/* Move the device into the configured state. */
    517 	(void) usbd_set_config_index(uaa->device, 0, 1);
    518 }
    519 
    520 static int
    521 u3ginit_detach(device_t self, int flags)
    522 {
    523 
    524 	return (0);
    525 }
    526 
    527 
    528 /*
    529  * Second personality:
    530  *
    531  * Claim only those interfaces required for 3G modem operation.
    532  */
    533 
    534 static int
    535 u3g_match(device_t parent, cfdata_t match, void *aux)
    536 {
    537 	struct usbif_attach_arg *uaa = aux;
    538 	usbd_interface_handle iface;
    539 	usb_interface_descriptor_t *id;
    540 	usbd_status error;
    541 
    542 	if (!usb_lookup(u3g_devs, uaa->vendor, uaa->product))
    543 		return (UMATCH_NONE);
    544 
    545 	error = usbd_device2interface_handle(uaa->device, uaa->ifaceno, &iface);
    546 	if (error) {
    547 		printf("u3g_match: failed to get interface, err=%s\n",
    548 		    usbd_errstr(error));
    549 		return (UMATCH_NONE);
    550 	}
    551 
    552 	id = usbd_get_interface_descriptor(iface);
    553 	if (id == NULL) {
    554 		printf("u3g_match: failed to get interface descriptor\n");
    555 		return (UMATCH_NONE);
    556 	}
    557 
    558 	/*
    559 	 * 3G modems generally report vendor-specific class
    560 	 *
    561 	 * XXX: this may be too generalised.
    562 	 */
    563 	return ((id->bInterfaceClass == UICLASS_VENDOR) ?
    564 	    UMATCH_VENDOR_PRODUCT : UMATCH_NONE);
    565 }
    566 
    567 static void
    568 u3g_attach(device_t parent, device_t self, void *aux)
    569 {
    570 	struct u3g_softc *sc = device_private(self);
    571 	struct usbif_attach_arg *uaa = aux;
    572 	usbd_device_handle dev = uaa->device;
    573 	usbd_interface_handle iface;
    574 	usb_interface_descriptor_t *id;
    575 	usb_endpoint_descriptor_t *ed;
    576 	struct ucom_attach_args uca;
    577 	usbd_status error;
    578 	int n, intr_address, intr_size;
    579 
    580 	aprint_naive("\n");
    581 	aprint_normal("\n");
    582 
    583 	sc->sc_dev = self;
    584 	sc->sc_dying = false;
    585 	sc->sc_udev = dev;
    586 
    587 	error = usbd_device2interface_handle(dev, uaa->ifaceno, &iface);
    588 	if (error) {
    589 		aprint_error_dev(self, "failed to get interface, err=%s\n",
    590 		    usbd_errstr(error));
    591 		return;
    592 	}
    593 
    594 	id = usbd_get_interface_descriptor(iface);
    595 
    596 	uca.info = "3G Modem";
    597 	uca.ibufsize = U3G_BUFF_SIZE;
    598 	uca.obufsize = U3G_BUFF_SIZE;
    599 	uca.ibufsizepad = U3G_BUFF_SIZE;
    600 	uca.portno = uaa->ifaceno;
    601 	uca.opkthdrlen = 0;
    602 	uca.device = dev;
    603 	uca.iface = iface;
    604 	uca.methods = &u3g_methods;
    605 	uca.arg = sc;
    606 	uca.bulkin = uca.bulkout = -1;
    607 
    608 	sc->sc_outpins = 0;
    609 	sc->sc_msr = UMSR_DSR | UMSR_CTS | UMSR_DCD;
    610 	sc->sc_ifaceno = uaa->ifaceno;
    611 	sc->sc_open = false;
    612 	sc->sc_purging = false;
    613 
    614 	intr_address = -1;
    615 	intr_size = 0;
    616 
    617 	for (n = 0; n < id->bNumEndpoints; n++) {
    618 		ed = usbd_interface2endpoint_descriptor(iface, n);
    619 		if (ed == NULL) {
    620 			aprint_error_dev(self, "no endpoint descriptor "
    621 			    "for %d (interface: %d)\n", n, sc->sc_ifaceno);
    622 			sc->sc_dying = true;
    623 			return;
    624 		}
    625 
    626 		if (UE_GET_DIR(ed->bEndpointAddress) == UE_DIR_IN &&
    627 		    UE_GET_XFERTYPE(ed->bmAttributes) == UE_INTERRUPT) {
    628 			intr_address = ed->bEndpointAddress;
    629 			intr_size = UGETW(ed->wMaxPacketSize);
    630 		} else
    631 		if (UE_GET_DIR(ed->bEndpointAddress) == UE_DIR_IN &&
    632 		    UE_GET_XFERTYPE(ed->bmAttributes) == UE_BULK) {
    633 			uca.bulkin = ed->bEndpointAddress;
    634 		} else
    635 		if (UE_GET_DIR(ed->bEndpointAddress) == UE_DIR_OUT &&
    636 		    UE_GET_XFERTYPE(ed->bmAttributes) == UE_BULK) {
    637 			uca.bulkout = ed->bEndpointAddress;
    638 		}
    639 	}
    640 
    641 	if (uca.bulkin == -1) {
    642 		aprint_error_dev(self, "Missing bulk in for interface %d\n",
    643 		    sc->sc_ifaceno);
    644 		sc->sc_dying = true;
    645 		return;
    646 	}
    647 
    648 	if (uca.bulkout == -1) {
    649 		aprint_error_dev(self, "Missing bulk out for interface %d\n",
    650 		    sc->sc_ifaceno);
    651 		sc->sc_dying = true;
    652 		return;
    653 	}
    654 
    655 	sc->sc_ucom = config_found_sm_loc(self, "ucombus",
    656 	    NULL, &uca, ucomprint, ucomsubmatch);
    657 
    658 	/*
    659 	 * If the interface has an interrupt pipe, open it immediately so
    660 	 * that we can track input pin state changes regardless of whether
    661 	 * the tty(4) device is open or not.
    662 	 */
    663 	if (intr_address != -1) {
    664 		sc->sc_intr_buff = malloc(intr_size, M_USBDEV, M_WAITOK);
    665 		error = usbd_open_pipe_intr(iface, intr_address,
    666 		    USBD_SHORT_XFER_OK, &sc->sc_intr_pipe, sc, sc->sc_intr_buff,
    667 		    intr_size, u3g_intr, 100);
    668 		if (error) {
    669 			aprint_error_dev(self, "cannot open interrupt pipe "
    670 			    "(addr %d)\n", intr_address);
    671 			return;
    672 		}
    673 	} else {
    674 		sc->sc_intr_pipe = NULL;
    675 		sc->sc_intr_buff = NULL;
    676 	}
    677 
    678 	if (!pmf_device_register(self, NULL, NULL))
    679 		aprint_error_dev(self, "couldn't establish power handler\n");
    680 }
    681 
    682 static int
    683 u3g_detach(device_t self, int flags)
    684 {
    685 	struct u3g_softc *sc = device_private(self);
    686 	int rv;
    687 
    688 	if (sc->sc_dying)
    689 		return 0;
    690 
    691 	pmf_device_deregister(self);
    692 
    693 	if (sc->sc_ucom != NULL) {
    694 		rv = config_detach(sc->sc_ucom, flags);
    695 		if (rv != 0) {
    696 			aprint_verbose_dev(self, "Can't deallocate "
    697 			    "port (%d)", rv);
    698 		}
    699 	}
    700 
    701 	if (sc->sc_intr_pipe != NULL) {
    702 		(void) usbd_abort_pipe(sc->sc_intr_pipe);
    703 		(void) usbd_close_pipe(sc->sc_intr_pipe);
    704 		sc->sc_intr_pipe = NULL;
    705 	}
    706 	if (sc->sc_intr_buff != NULL) {
    707 		free(sc->sc_intr_buff, M_USBDEV);
    708 		sc->sc_intr_buff = NULL;
    709 	}
    710 
    711 	return (0);
    712 }
    713 
    714 static void
    715 u3g_childdet(device_t self, device_t child)
    716 {
    717 	struct u3g_softc *sc = device_private(self);
    718 
    719 	if (sc->sc_ucom == child)
    720 		sc->sc_ucom = NULL;
    721 }
    722 
    723 static int
    724 u3g_activate(device_t self, enum devact act)
    725 {
    726 	struct u3g_softc *sc = device_private(self);
    727 	int rv;
    728 
    729 	switch (act) {
    730 	case DVACT_DEACTIVATE:
    731 		if (sc->sc_ucom != NULL && config_deactivate(sc->sc_ucom))
    732 			rv = -1;
    733 		else
    734 			rv = 0;
    735 		break;
    736 
    737 	default:
    738 		rv = 0;
    739 		break;
    740 	}
    741 
    742 	return (rv);
    743 }
    744 
    745 static void
    746 u3g_intr(usbd_xfer_handle xfer, usbd_private_handle priv, usbd_status status)
    747 {
    748 	struct u3g_softc *sc = (struct u3g_softc *)priv;
    749 	u_char *buf;
    750 
    751 	if (sc->sc_dying)
    752 		return;
    753 
    754 	if (status != USBD_NORMAL_COMPLETION) {
    755 		if (status == USBD_NOT_STARTED || status == USBD_CANCELLED)
    756 			return;
    757 		usbd_clear_endpoint_stall_async(sc->sc_intr_pipe);
    758 		return;
    759 	}
    760 
    761 	buf = sc->sc_intr_buff;
    762 	if (buf[0] == 0xa1 && buf[1] == 0x20) {
    763 		u_char msr;
    764 
    765 		msr = sc->sc_msr & ~(UMSR_DCD | UMSR_DSR | UMSR_RI);
    766 
    767 		if (buf[8] & U3G_INPIN_DCD)
    768 			msr |= UMSR_DCD;
    769 
    770 		if (buf[8] & U3G_INPIN_DSR)
    771 			msr |= UMSR_DSR;
    772 
    773 		if (buf[8] & U3G_INPIN_RI)
    774 			msr |= UMSR_RI;
    775 
    776 		if (msr != sc->sc_msr) {
    777 			sc->sc_msr = msr;
    778 			if (sc->sc_open)
    779 				ucom_status_change(device_private(sc->sc_ucom));
    780 		}
    781 	}
    782 }
    783 
    784 /*ARGSUSED*/
    785 static void
    786 u3g_get_status(void *arg, int portno, u_char *lsr, u_char *msr)
    787 {
    788 	struct u3g_softc *sc = arg;
    789 
    790 	if (lsr != NULL)
    791 		*lsr = 0;	/* LSR isn't supported */
    792 	if (msr != NULL)
    793 		*msr = sc->sc_msr;
    794 }
    795 
    796 /*ARGSUSED*/
    797 static void
    798 u3g_set(void *arg, int portno, int reg, int onoff)
    799 {
    800 	struct u3g_softc *sc = arg;
    801 	usb_device_request_t req;
    802 	uint16_t mask, new_state;
    803 	usbd_status err;
    804 
    805 	if (sc->sc_dying)
    806 		return;
    807 
    808 	switch (reg) {
    809 	case UCOM_SET_DTR:
    810 		mask = U3G_OUTPIN_DTR;
    811 		break;
    812 	case UCOM_SET_RTS:
    813 		mask = U3G_OUTPIN_RTS;
    814 		break;
    815 	default:
    816 		return;
    817 	}
    818 
    819 	new_state = sc->sc_outpins & ~mask;
    820 	if (onoff)
    821 		new_state |= mask;
    822 
    823 	if (new_state == sc->sc_outpins)
    824 		return;
    825 
    826 	sc->sc_outpins = new_state;
    827 
    828 	req.bmRequestType = UT_WRITE_CLASS_INTERFACE;
    829 	req.bRequest = U3G_SET_PIN;
    830 	USETW(req.wValue, new_state);
    831 	USETW(req.wIndex, sc->sc_ifaceno);
    832 	USETW(req.wLength, 0);
    833 
    834 	err = usbd_do_request(sc->sc_udev, &req, 0);
    835 	if (err == USBD_STALLED)
    836 		usbd_clear_endpoint_stall(sc->sc_udev->default_pipe);
    837 }
    838 
    839 /*ARGSUSED*/
    840 static int
    841 u3g_open(void *arg, int portno)
    842 {
    843 	struct u3g_softc *sc = arg;
    844 	usb_device_request_t req;
    845 	usb_endpoint_descriptor_t *ed;
    846 	usb_interface_descriptor_t *id;
    847 	usbd_interface_handle ih;
    848 	usbd_status err;
    849 	int i;
    850 
    851 	if (sc->sc_dying)
    852 		return (0);
    853 
    854 	err = usbd_device2interface_handle(sc->sc_udev, portno, &ih);
    855 	if (err)
    856 		return (EIO);
    857 
    858 	id = usbd_get_interface_descriptor(ih);
    859 
    860 	for (i = 0; i < id->bNumEndpoints; i++) {
    861 		ed = usbd_interface2endpoint_descriptor(ih, i);
    862 		if (ed == NULL)
    863 			return (EIO);
    864 
    865 		if (UE_GET_XFERTYPE(ed->bmAttributes) == UE_BULK) {
    866 			/* Issue ENDPOINT_HALT request */
    867 			req.bmRequestType = UT_WRITE_ENDPOINT;
    868 			req.bRequest = UR_CLEAR_FEATURE;
    869 			USETW(req.wValue, UF_ENDPOINT_HALT);
    870 			USETW(req.wIndex, ed->bEndpointAddress);
    871 			USETW(req.wLength, 0);
    872 			err = usbd_do_request(sc->sc_udev, &req, 0);
    873 			if (err)
    874 				return (EIO);
    875 		}
    876 	}
    877 
    878 	sc->sc_open = true;
    879 	sc->sc_purging = true;
    880 	getmicrotime(&sc->sc_purge_start);
    881 
    882 	return (0);
    883 }
    884 
    885 /*ARGSUSED*/
    886 static void
    887 u3g_close(void *arg, int portno)
    888 {
    889 	struct u3g_softc *sc = arg;
    890 
    891 	sc->sc_open = false;
    892 }
    893 
    894 /*ARGSUSED*/
    895 static void
    896 u3g_read(void *arg, int portno, u_char **cpp, uint32_t *ccp)
    897 {
    898 	struct u3g_softc *sc = arg;
    899 	struct timeval curr_tv, diff_tv;
    900 
    901 	/*
    902 	 * If we're not purging input data following first open, do nothing.
    903 	 */
    904 	if (sc->sc_purging == false)
    905 		return;
    906 
    907 	/*
    908 	 * Otherwise check if the purge timeout has expired
    909 	 */
    910 	getmicrotime(&curr_tv);
    911 	timersub(&curr_tv, &sc->sc_purge_start, &diff_tv);
    912 
    913 	if (diff_tv.tv_sec >= U3G_PURGE_SECS) {
    914 		/* Timeout expired. */
    915 		sc->sc_purging = false;
    916 	} else {
    917 		/* Still purging. Adjust the caller's byte count. */
    918 		*ccp = 0;
    919 	}
    920 }
    921 
    922 /*ARGSUSED*/
    923 static void
    924 u3g_write(void *arg, int portno, u_char *to, u_char *from, u_int32_t *count)
    925 {
    926 	struct u3g_softc *sc = arg;
    927 
    928 	/*
    929 	 * Stop purging as soon as the first data is written to the device.
    930 	 */
    931 	sc->sc_purging = false;
    932 	memcpy(to, from, *count);
    933 }
    934