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