Home | History | Annotate | Line # | Download | only in usb
uslsa.c revision 1.10
      1  1.10    plunky /* $NetBSD: uslsa.c,v 1.10 2009/09/23 19:07:19 plunky Exp $ */
      2   1.9  jakllsch 
      3   1.9  jakllsch /* from ugensa.c */
      4   1.2   xtraeme 
      5   1.1    dogcow /*
      6   1.9  jakllsch  * Copyright (c) 2004, 2005 The NetBSD Foundation, Inc.
      7   1.1    dogcow  * All rights reserved.
      8   1.1    dogcow  *
      9   1.1    dogcow  * This code is derived from software contributed to The NetBSD Foundation
     10   1.9  jakllsch  * by Roland C. Dowdeswell <elric (at) netbsd.org>.
     11   1.1    dogcow  *
     12   1.1    dogcow  * Redistribution and use in source and binary forms, with or without
     13   1.1    dogcow  * modification, are permitted provided that the following conditions
     14   1.1    dogcow  * are met:
     15   1.1    dogcow  * 1. Redistributions of source code must retain the above copyright
     16   1.1    dogcow  *    notice, this list of conditions and the following disclaimer.
     17   1.1    dogcow  * 2. Redistributions in binary form must reproduce the above copyright
     18   1.1    dogcow  *    notice, this list of conditions and the following disclaimer in the
     19   1.1    dogcow  *    documentation and/or other materials provided with the distribution.
     20   1.1    dogcow  *
     21   1.1    dogcow  * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
     22   1.1    dogcow  * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
     23   1.1    dogcow  * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
     24   1.1    dogcow  * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
     25   1.1    dogcow  * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
     26   1.1    dogcow  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
     27   1.1    dogcow  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
     28   1.1    dogcow  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
     29   1.1    dogcow  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
     30   1.1    dogcow  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
     31   1.1    dogcow  * POSSIBILITY OF SUCH DAMAGE.
     32   1.1    dogcow  */
     33   1.1    dogcow 
     34   1.9  jakllsch /*
     35   1.9  jakllsch  * Copyright (c) 2007, 2009 Jonathan A. Kollasch.
     36   1.9  jakllsch  * All rights reserved.
     37   1.9  jakllsch  *
     38   1.9  jakllsch  * Redistribution and use in source and binary forms, with or without
     39   1.9  jakllsch  * modification, are permitted provided that the following conditions
     40   1.9  jakllsch  * are met:
     41   1.9  jakllsch  * 1. Redistributions of source code must retain the above copyright
     42   1.9  jakllsch  *    notice, this list of conditions and the following disclaimer.
     43   1.9  jakllsch  * 2. Redistributions in binary form must reproduce the above copyright
     44   1.9  jakllsch  *    notice, this list of conditions and the following disclaimer in the
     45   1.9  jakllsch  *    documentation and/or other materials provided with the distribution.
     46   1.9  jakllsch  *
     47   1.9  jakllsch  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
     48   1.9  jakllsch  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
     49   1.9  jakllsch  * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
     50   1.9  jakllsch  * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
     51   1.9  jakllsch  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
     52   1.9  jakllsch  * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
     53   1.9  jakllsch  * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
     54   1.9  jakllsch  * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
     55   1.9  jakllsch  * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
     56   1.9  jakllsch  * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
     57   1.9  jakllsch  *
     58   1.9  jakllsch  */
     59   1.9  jakllsch 
     60   1.9  jakllsch /*
     61   1.9  jakllsch  * Craig Shelley's Linux driver was used for documentation.
     62   1.9  jakllsch  */
     63   1.9  jakllsch 
     64   1.2   xtraeme #include <sys/cdefs.h>
     65  1.10    plunky __KERNEL_RCSID(0, "$NetBSD: uslsa.c,v 1.10 2009/09/23 19:07:19 plunky Exp $");
     66   1.2   xtraeme 
     67   1.1    dogcow #include <sys/param.h>
     68   1.1    dogcow #include <sys/systm.h>
     69   1.1    dogcow #include <sys/kernel.h>
     70   1.1    dogcow #include <sys/device.h>
     71   1.1    dogcow #include <sys/conf.h>
     72   1.1    dogcow #include <sys/tty.h>
     73   1.1    dogcow 
     74   1.1    dogcow #include <dev/usb/usb.h>
     75   1.1    dogcow 
     76   1.1    dogcow #include <dev/usb/usbdi.h>
     77   1.1    dogcow #include <dev/usb/usbdi_util.h>
     78   1.1    dogcow #include <dev/usb/usbdevs.h>
     79   1.1    dogcow 
     80   1.1    dogcow #include <dev/usb/ucomvar.h>
     81   1.1    dogcow 
     82   1.1    dogcow #ifdef DEBUG
     83   1.1    dogcow #define USLSA_DEBUG
     84   1.1    dogcow #endif
     85   1.1    dogcow 
     86   1.1    dogcow #ifdef USLSA_DEBUG
     87   1.1    dogcow #define DPRINTF(x)	if (uslsadebug) printf x
     88   1.1    dogcow #define DPRINTFN(n,x)	if (uslsadebug>(n)) printf x
     89   1.1    dogcow int uslsadebug = 0;
     90   1.1    dogcow #else
     91   1.1    dogcow #define DPRINTF(x)
     92   1.1    dogcow #define DPRINTFN(n,x)
     93   1.1    dogcow #endif
     94   1.1    dogcow 
     95   1.1    dogcow #define USLSA_REQ_SET_STATE	0x00
     96   1.1    dogcow 
     97   1.1    dogcow #define USLSA_REQ_SET_BPS	0x01
     98   1.1    dogcow #define USLSA_REQ_GET_BPS	0x02
     99   1.1    dogcow 
    100   1.1    dogcow #define USLSA_REQ_SET_DPS	0x03
    101   1.1    dogcow #define USLSA_REQ_GET_DPS	0x04
    102   1.1    dogcow 
    103   1.1    dogcow #define USLSA_REQ_SET_BREAK	0x05
    104   1.1    dogcow #define USLSA_REQ_GET_BREAK	0x06
    105   1.1    dogcow 
    106   1.1    dogcow #define USLSA_REQ_SET_FLOW	0x07
    107   1.1    dogcow #define USLSA_REQ_GET_FLOW	0x08
    108   1.1    dogcow 
    109   1.1    dogcow #define USLSA_REQ_SET_MODEM	0x13
    110   1.1    dogcow #define USLSA_REQ_GET_MODEM	0x14
    111   1.1    dogcow 
    112   1.1    dogcow #define USLSA_REQ_SET_MISC	0x19
    113   1.1    dogcow #define USLSA_REQ_GET_MISC	0x20
    114   1.1    dogcow 
    115   1.1    dogcow #define USLSA_STATE_DISABLE	0x0000
    116   1.1    dogcow #define USLSA_STATE_ENABLE	0x0001
    117   1.1    dogcow 
    118   1.1    dogcow #define USLSA_BPS(b)	(3686400/b)
    119   1.1    dogcow 
    120   1.1    dogcow #define USLSA_DPS_DATA_MASK		0x0f00
    121   1.1    dogcow #define	USLSA_DPS_DATA_FIVE		0x0500
    122   1.1    dogcow #define	USLSA_DPS_DATA_SIX		0x0600
    123   1.1    dogcow #define	USLSA_DPS_DATA_SEVEN		0x0700
    124   1.1    dogcow #define	USLSA_DPS_DATA_EIGHT		0x0800
    125   1.1    dogcow #define	USLSA_DPS_DATA_NINE		0x0900
    126   1.1    dogcow 
    127   1.1    dogcow #define USLSA_DPS_PARITY_MASK		0x00f0
    128   1.1    dogcow #define USLSA_DPS_PARITY_SPACE		0x0040
    129   1.1    dogcow #define USLSA_DPS_PARITY_MARK		0x0030
    130   1.1    dogcow #define USLSA_DPS_PARITY_EVEN		0x0020
    131   1.1    dogcow #define USLSA_DPS_PARITY_ODD		0x0010
    132   1.1    dogcow #define USLSA_DPS_PARITY_NONE		0x0000
    133   1.1    dogcow 
    134   1.1    dogcow #define USLSA_DPS_STOP_MASK		0x000f
    135   1.1    dogcow #define USLSA_DPS_STOP_TWO		0x0002
    136   1.1    dogcow #define USLSA_DPS_STOP_ONE_FIVE		0x0001
    137   1.1    dogcow #define USLSA_DPS_STOP_ONE		0x0000
    138   1.1    dogcow 
    139   1.1    dogcow #define USLSA_BREAK_DISABLE	0x0001
    140   1.1    dogcow #define USLSA_BREAK_ENABLE	0x0000
    141   1.1    dogcow 
    142   1.1    dogcow #define USLSA_FLOW_SET_RTS	0x0200
    143   1.1    dogcow #define USLSA_FLOW_SET_DTR	0x0100
    144   1.1    dogcow #define USLSA_FLOW_MSR_MASK	0x00f0
    145   1.1    dogcow #define USLSA_FLOW_MSR_DCD	0x0080
    146   1.1    dogcow #define USLSA_FLOW_MSR_RI	0x0040
    147   1.1    dogcow #define USLSA_FLOW_MSR_DSR	0x0020
    148   1.1    dogcow #define USLSA_FLOW_MSR_CTS	0x0010
    149   1.1    dogcow #define USLSA_FLOW_RTS		0x0002
    150   1.1    dogcow #define USLSA_FLOW_DTR		0x0001
    151   1.1    dogcow 
    152   1.1    dogcow struct uslsa_softc {
    153   1.1    dogcow 	USBBASEDEVICE		sc_dev;		/* base device */
    154   1.1    dogcow 	usbd_device_handle	sc_udev;	/* device */
    155   1.1    dogcow 	usbd_interface_handle	sc_iface;	/* interface */
    156   1.1    dogcow 
    157   1.5    dyoung 	device_t		sc_subdev;	/* ucom device */
    158   1.1    dogcow 
    159   1.1    dogcow 	u_char			sc_dying;	/* disconnecting */
    160   1.1    dogcow 
    161   1.1    dogcow 	u_char			sc_lsr;		/* local status register */
    162   1.1    dogcow 	u_char			sc_msr;		/* uslsa status register */
    163   1.1    dogcow };
    164   1.1    dogcow 
    165   1.1    dogcow static void uslsa_get_status(void *sc, int, u_char *, u_char *);
    166   1.1    dogcow static void uslsa_set(void *, int, int, int);
    167   1.1    dogcow static int uslsa_param(void *, int, struct termios *);
    168   1.1    dogcow static int uslsa_open(void *, int);
    169   1.1    dogcow static void uslsa_close(void *, int);
    170   1.1    dogcow 
    171   1.1    dogcow static int uslsa_request_set(struct uslsa_softc *, uint8_t, uint16_t);
    172   1.1    dogcow static void uslsa_set_flow(struct uslsa_softc *, tcflag_t, tcflag_t);
    173   1.1    dogcow 
    174   1.1    dogcow struct ucom_methods uslsa_methods = {
    175   1.1    dogcow 	uslsa_get_status,
    176   1.1    dogcow 	uslsa_set,
    177   1.1    dogcow 	uslsa_param,
    178   1.1    dogcow 	NULL,
    179   1.1    dogcow 	uslsa_open,
    180   1.1    dogcow 	uslsa_close,
    181   1.1    dogcow 	NULL,
    182   1.1    dogcow 	NULL,
    183   1.1    dogcow };
    184   1.1    dogcow 
    185   1.1    dogcow #define USLSA_CONFIG_INDEX	0
    186   1.1    dogcow #define USLSA_IFACE_INDEX	0
    187   1.1    dogcow #define USLSA_BUFSIZE		256
    188   1.1    dogcow 
    189   1.1    dogcow static const struct usb_devno uslsa_devs[] = {
    190   1.1    dogcow         { USB_VENDOR_BALTECH,           USB_PRODUCT_BALTECH_CARDREADER },
    191   1.1    dogcow         { USB_VENDOR_DYNASTREAM,        USB_PRODUCT_DYNASTREAM_ANTDEVBOARD },
    192   1.1    dogcow         { USB_VENDOR_JABLOTRON,         USB_PRODUCT_JABLOTRON_PC60B },
    193   1.1    dogcow         { USB_VENDOR_SILABS,            USB_PRODUCT_SILABS_ARGUSISP },
    194   1.1    dogcow         { USB_VENDOR_SILABS,            USB_PRODUCT_SILABS_CRUMB128 },
    195   1.1    dogcow         { USB_VENDOR_SILABS,            USB_PRODUCT_SILABS_DEGREECONT },
    196   1.1    dogcow         { USB_VENDOR_SILABS,            USB_PRODUCT_SILABS_DESKTOPMOBILE },
    197   1.1    dogcow         { USB_VENDOR_SILABS,            USB_PRODUCT_SILABS_IPLINK1220 },
    198   1.1    dogcow         { USB_VENDOR_SILABS,            USB_PRODUCT_SILABS_LIPOWSKY_HARP },
    199   1.1    dogcow         { USB_VENDOR_SILABS,            USB_PRODUCT_SILABS_LIPOWSKY_JTAG },
    200   1.1    dogcow         { USB_VENDOR_SILABS,            USB_PRODUCT_SILABS_LIPOWSKY_LIN },
    201   1.1    dogcow         { USB_VENDOR_SILABS,            USB_PRODUCT_SILABS_POLOLU },
    202   1.1    dogcow         { USB_VENDOR_SILABS,            USB_PRODUCT_SILABS_CP210X_1 },
    203   1.1    dogcow         { USB_VENDOR_SILABS,            USB_PRODUCT_SILABS_CP210X_2 },
    204   1.1    dogcow         { USB_VENDOR_SILABS,            USB_PRODUCT_SILABS_SUNNTO },
    205   1.1    dogcow         { USB_VENDOR_SILABS2,           USB_PRODUCT_SILABS2_DCU11CLONE },
    206   1.1    dogcow         { USB_VENDOR_USI,               USB_PRODUCT_USI_MC60 }
    207   1.1    dogcow };
    208   1.1    dogcow #define uslsa_lookup(v, p) usb_lookup(uslsa_devs, v, p)
    209   1.1    dogcow 
    210   1.8      cube int uslsa_match(device_t, cfdata_t, void *);
    211   1.5    dyoung void uslsa_attach(device_t, device_t, void *);
    212   1.5    dyoung void uslsa_childdet(device_t, device_t);
    213   1.5    dyoung int uslsa_detach(device_t, int);
    214   1.5    dyoung int uslsa_activate(device_t, enum devact);
    215   1.5    dyoung extern struct cfdriver uslsa_cd;
    216   1.8      cube CFATTACH_DECL2_NEW(uslsa, sizeof(struct uslsa_softc), uslsa_match,
    217   1.5    dyoung     uslsa_attach, uslsa_detach, uslsa_activate, NULL, uslsa_childdet);
    218   1.1    dogcow 
    219   1.1    dogcow USB_MATCH(uslsa)
    220   1.1    dogcow {
    221   1.1    dogcow 	USB_MATCH_START(uslsa, uaa);
    222   1.1    dogcow 
    223   1.1    dogcow 	return (uslsa_lookup(uaa->vendor, uaa->product) != NULL ?
    224   1.1    dogcow 	        UMATCH_VENDOR_PRODUCT : UMATCH_NONE);
    225   1.1    dogcow }
    226   1.1    dogcow 
    227   1.1    dogcow USB_ATTACH(uslsa)
    228   1.1    dogcow {
    229   1.1    dogcow 	USB_ATTACH_START(uslsa, sc, uaa);
    230   1.1    dogcow 	usbd_device_handle dev = uaa->device;
    231   1.1    dogcow 	usbd_interface_handle iface;
    232   1.1    dogcow 	usb_interface_descriptor_t *id;
    233   1.1    dogcow 	usb_endpoint_descriptor_t *ed;
    234   1.1    dogcow 	char *devinfop;
    235   1.1    dogcow 	usbd_status err;
    236   1.1    dogcow 	struct ucom_attach_args uca;
    237   1.1    dogcow 	int i;
    238   1.1    dogcow 
    239   1.8      cube 	sc->sc_dev = self;
    240   1.1    dogcow 
    241   1.1    dogcow 	DPRINTFN(10, ("\nuslsa_attach: sc=%p\n", sc));
    242   1.1    dogcow 
    243  1.10    plunky 	aprint_naive("\n");
    244  1.10    plunky 	aprint_normal("\n");
    245  1.10    plunky 
    246  1.10    plunky 	devinfop = usbd_devinfo_alloc(dev, 0);
    247  1.10    plunky 	aprint_normal_dev(self, "%s\n", devinfop);
    248  1.10    plunky 	usbd_devinfo_free(devinfop);
    249  1.10    plunky 
    250   1.1    dogcow 	/* Move the device into the configured state. */
    251   1.1    dogcow 	err = usbd_set_config_index(dev, USLSA_CONFIG_INDEX, 1);
    252   1.1    dogcow 	if (err) {
    253  1.10    plunky 		aprint_error_dev(self, "failed to set configuration, err=%s\n",
    254  1.10    plunky 		   usbd_errstr(err));
    255   1.1    dogcow 		goto bad;
    256   1.1    dogcow 	}
    257   1.1    dogcow 
    258   1.1    dogcow 	err = usbd_device2interface_handle(dev, USLSA_IFACE_INDEX, &iface);
    259   1.1    dogcow 	if (err) {
    260  1.10    plunky 		aprint_error_dev(self, "failed to get interface, err=%s\n",
    261  1.10    plunky 		   usbd_errstr(err));
    262   1.1    dogcow 		goto bad;
    263   1.1    dogcow 	}
    264   1.1    dogcow 
    265   1.1    dogcow 	id = usbd_get_interface_descriptor(iface);
    266   1.1    dogcow 
    267   1.1    dogcow 	sc->sc_udev = dev;
    268   1.1    dogcow 	sc->sc_iface = iface;
    269   1.1    dogcow 
    270   1.1    dogcow 	uca.info = "Silicon Labs CP210x";
    271   1.3   nathanw 	uca.portno = UCOM_UNK_PORTNO;
    272   1.1    dogcow 	uca.ibufsize = USLSA_BUFSIZE;
    273   1.1    dogcow 	uca.obufsize = USLSA_BUFSIZE;
    274   1.1    dogcow 	uca.ibufsizepad = USLSA_BUFSIZE;
    275   1.1    dogcow 	uca.opkthdrlen = 0;
    276   1.1    dogcow 	uca.device = dev;
    277   1.1    dogcow 	uca.iface = iface;
    278   1.1    dogcow 	uca.methods = &uslsa_methods;
    279   1.1    dogcow 	uca.arg = sc;
    280   1.1    dogcow 
    281   1.1    dogcow 	usbd_add_drv_event(USB_EVENT_DRIVER_ATTACH, sc->sc_udev,
    282   1.1    dogcow 	                   USBDEV(sc->sc_dev));
    283   1.1    dogcow 
    284   1.1    dogcow 	uca.bulkin = uca.bulkout = -1;
    285   1.1    dogcow 	for (i = 0; i < id->bNumEndpoints; i++) {
    286   1.1    dogcow 		int addr, dir, attr;
    287   1.1    dogcow 
    288   1.1    dogcow 		ed = usbd_interface2endpoint_descriptor(iface, i);
    289   1.1    dogcow 		if (ed == NULL) {
    290   1.8      cube 			aprint_error_dev(self,
    291   1.8      cube 			    "could not read endpoint descriptor: %s\n",
    292   1.8      cube 			    usbd_errstr(err));
    293   1.1    dogcow 			goto bad;
    294   1.1    dogcow 		}
    295   1.1    dogcow 		addr = ed->bEndpointAddress;
    296   1.1    dogcow 		dir = UE_GET_DIR(ed->bEndpointAddress);
    297   1.1    dogcow 		attr = ed->bmAttributes & UE_XFERTYPE;
    298   1.1    dogcow 		if (dir == UE_DIR_IN && attr == UE_BULK)
    299   1.1    dogcow 			uca.bulkin = addr;
    300   1.1    dogcow 		else if (dir == UE_DIR_OUT && attr == UE_BULK)
    301   1.1    dogcow 			uca.bulkout = addr;
    302   1.1    dogcow 		else
    303   1.8      cube 			aprint_error_dev(self, "unexpected endpoint\n");
    304   1.1    dogcow 	}
    305   1.1    dogcow 	if (uca.bulkin == -1) {
    306   1.8      cube 		aprint_error_dev(self, "Could not find data bulk in\n");
    307   1.1    dogcow 		goto bad;
    308   1.1    dogcow 	}
    309   1.1    dogcow 	if (uca.bulkout == -1) {
    310   1.8      cube 		aprint_error_dev(self, "Could not find data bulk out\n");
    311   1.1    dogcow 		goto bad;
    312   1.1    dogcow 	}
    313   1.1    dogcow 
    314   1.1    dogcow 	DPRINTF(("uslsa: in=0x%x out=0x%x\n", uca.bulkin, uca.bulkout));
    315   1.1    dogcow 	sc->sc_subdev = config_found_sm_loc(self, "ucombus", NULL, &uca,
    316   1.1    dogcow 	                                    ucomprint, ucomsubmatch);
    317   1.1    dogcow 
    318   1.1    dogcow 	USB_ATTACH_SUCCESS_RETURN;
    319   1.1    dogcow 
    320   1.1    dogcow bad:
    321   1.1    dogcow 	DPRINTF(("uslsa_attach: ATTACH ERROR\n"));
    322   1.1    dogcow 	sc->sc_dying = 1;
    323   1.1    dogcow 	USB_ATTACH_ERROR_RETURN;
    324   1.1    dogcow }
    325   1.1    dogcow 
    326   1.1    dogcow int
    327   1.5    dyoung uslsa_activate(device_t self, enum devact act)
    328   1.1    dogcow {
    329   1.5    dyoung 	struct uslsa_softc *sc = device_private(self);
    330   1.1    dogcow 	int rv = 0;
    331   1.1    dogcow 
    332   1.1    dogcow 	switch (act) {
    333   1.1    dogcow 	case DVACT_ACTIVATE:
    334   1.1    dogcow 		return (EOPNOTSUPP);
    335   1.1    dogcow 		break;
    336   1.1    dogcow 
    337   1.1    dogcow 	case DVACT_DEACTIVATE:
    338   1.1    dogcow 		sc->sc_dying = 1;
    339   1.1    dogcow 		if (sc->sc_subdev)
    340   1.1    dogcow 			rv = config_deactivate(sc->sc_subdev);
    341   1.1    dogcow 		break;
    342   1.1    dogcow 	}
    343   1.1    dogcow 	return (rv);
    344   1.1    dogcow }
    345   1.1    dogcow 
    346   1.5    dyoung void
    347   1.5    dyoung uslsa_childdet(device_t self, device_t child)
    348   1.5    dyoung {
    349   1.5    dyoung 	struct uslsa_softc *sc = device_private(self);
    350   1.5    dyoung 
    351   1.5    dyoung 	KASSERT(sc->sc_subdev == child);
    352   1.5    dyoung 	sc->sc_subdev = NULL;
    353   1.5    dyoung }
    354   1.5    dyoung 
    355   1.1    dogcow USB_DETACH(uslsa)
    356   1.1    dogcow {
    357   1.1    dogcow 	USB_DETACH_START(uslsa, sc);
    358   1.1    dogcow 	int rv = 0;
    359   1.1    dogcow 
    360   1.1    dogcow 	DPRINTF(("uslsa_detach: sc=%p flags=%d\n", sc, flags));
    361   1.1    dogcow 
    362   1.1    dogcow 	sc->sc_dying = 1;
    363   1.1    dogcow 
    364   1.1    dogcow 	if (sc->sc_subdev != NULL)
    365   1.1    dogcow 		rv = config_detach(sc->sc_subdev, flags);
    366   1.1    dogcow 
    367   1.1    dogcow 	usbd_add_drv_event(USB_EVENT_DRIVER_DETACH, sc->sc_udev,
    368   1.1    dogcow 	                   USBDEV(sc->sc_dev));
    369   1.1    dogcow 
    370   1.1    dogcow 	return (rv);
    371   1.1    dogcow }
    372   1.1    dogcow 
    373   1.1    dogcow static void
    374   1.1    dogcow uslsa_get_status(void *vsc, int portno, u_char *lsr, u_char *msr)
    375   1.1    dogcow {
    376   1.1    dogcow 	struct uslsa_softc *sc;
    377   1.1    dogcow 	usb_device_request_t req;
    378   1.1    dogcow 	usbd_status err;
    379   1.1    dogcow 	int actlen;
    380   1.1    dogcow 	uint16_t flowreg;
    381   1.1    dogcow 
    382   1.1    dogcow 	sc = vsc;
    383   1.1    dogcow 
    384   1.1    dogcow 	DPRINTF(("uslsa_get_status:\n"));
    385   1.1    dogcow 
    386   1.9  jakllsch 	req.bmRequestType = UT_READ_VENDOR_INTERFACE;
    387   1.1    dogcow 	req.bRequest = USLSA_REQ_GET_FLOW;
    388   1.1    dogcow 	USETW(req.wValue, 0);
    389   1.1    dogcow 	USETW(req.wIndex, 0);
    390   1.1    dogcow 	USETW(req.wLength, sizeof(flowreg));
    391   1.1    dogcow 
    392   1.1    dogcow 	err = usbd_do_request_flags(sc->sc_udev, &req, &flowreg,
    393   1.1    dogcow 	    USBD_SHORT_XFER_OK, &actlen, USBD_DEFAULT_TIMEOUT);
    394   1.1    dogcow 	if (err)
    395   1.1    dogcow 		printf("%s: uslsa_get_status: %s\n",
    396   1.1    dogcow 		    USBDEVNAME(sc->sc_dev), usbd_errstr(err));
    397   1.1    dogcow 
    398   1.1    dogcow 	DPRINTF(("uslsa_get_status: flowreg=0x%x\n", flowreg));
    399   1.1    dogcow 
    400   1.1    dogcow 	sc->sc_msr = (u_char)(USLSA_FLOW_MSR_MASK & flowreg);
    401   1.1    dogcow 
    402   1.1    dogcow 	if (lsr != NULL)
    403   1.1    dogcow 		*lsr = sc->sc_lsr;
    404   1.1    dogcow 	if (msr != NULL)
    405   1.1    dogcow 		*msr = sc->sc_msr;
    406   1.1    dogcow }
    407   1.1    dogcow 
    408   1.1    dogcow static void
    409   1.1    dogcow uslsa_set(void *vsc, int portno, int reg, int onoff)
    410   1.1    dogcow {
    411   1.1    dogcow 	struct uslsa_softc *sc;
    412   1.1    dogcow 
    413   1.1    dogcow 	sc = vsc;
    414   1.1    dogcow 
    415   1.1    dogcow 	DPRINTF(("uslsa_set: sc=%p, port=%d reg=%d onoff=%d\n", sc, portno,
    416   1.1    dogcow 	         reg, onoff));
    417   1.1    dogcow 
    418   1.1    dogcow 	switch (reg) {
    419   1.1    dogcow 	case UCOM_SET_DTR:
    420   1.1    dogcow 		if (uslsa_request_set(sc, USLSA_REQ_SET_FLOW,
    421   1.1    dogcow 			(onoff ? (USLSA_FLOW_DTR | USLSA_FLOW_SET_DTR) :
    422   1.1    dogcow 			    USLSA_FLOW_SET_DTR)))
    423   1.1    dogcow 			printf("%s: uslsa_set_dtr failed\n",
    424   1.1    dogcow 			       USBDEVNAME(sc->sc_dev));
    425   1.1    dogcow 		break;
    426   1.1    dogcow 	case UCOM_SET_RTS:
    427   1.1    dogcow 		if (uslsa_request_set(sc, USLSA_REQ_SET_FLOW,
    428   1.1    dogcow 			(onoff ? (USLSA_FLOW_RTS | USLSA_FLOW_SET_RTS) :
    429   1.1    dogcow 			    USLSA_FLOW_SET_RTS)))
    430   1.1    dogcow 			printf("%s: uslsa_set_rts failed\n",
    431   1.1    dogcow 			       USBDEVNAME(sc->sc_dev));
    432   1.1    dogcow 		break;
    433   1.1    dogcow 	case UCOM_SET_BREAK:
    434   1.1    dogcow 		if (uslsa_request_set(sc, USLSA_REQ_SET_BREAK,
    435   1.1    dogcow 			(onoff ? USLSA_BREAK_ENABLE :
    436   1.1    dogcow 			    USLSA_BREAK_DISABLE)))
    437   1.1    dogcow 			printf("%s: uslsa_set_break failed\n",
    438   1.1    dogcow 			       USBDEVNAME(sc->sc_dev));
    439   1.1    dogcow 		break;
    440   1.1    dogcow 	default:
    441   1.1    dogcow 		break;
    442   1.1    dogcow 	}
    443   1.1    dogcow }
    444   1.1    dogcow 
    445   1.1    dogcow static int
    446   1.1    dogcow uslsa_param(void *vsc, int portno, struct termios * t)
    447   1.1    dogcow {
    448   1.1    dogcow 	struct uslsa_softc *sc;
    449   1.1    dogcow 	uint16_t data;
    450   1.1    dogcow 
    451   1.1    dogcow 	sc = vsc;
    452   1.1    dogcow 
    453   1.1    dogcow 	DPRINTF(("uslsa_param: sc=%p\n", sc));
    454   1.1    dogcow 
    455   1.1    dogcow 	switch (t->c_ospeed) {
    456   1.1    dogcow 	case B600:
    457   1.1    dogcow 	case B1200:
    458   1.1    dogcow 	case B2400:
    459   1.1    dogcow 	case B4800:
    460   1.1    dogcow 	case B9600:
    461   1.1    dogcow 	case B19200:
    462   1.1    dogcow 	case B38400:
    463   1.1    dogcow 	case B57600:
    464   1.1    dogcow 	case B115200:
    465   1.1    dogcow 	case B230400:
    466   1.1    dogcow 	case B460800:
    467   1.1    dogcow 	case B921600:
    468   1.1    dogcow 		data = USLSA_BPS(t->c_ospeed);
    469   1.1    dogcow 		break;
    470   1.1    dogcow 	default:
    471   1.1    dogcow 		printf("%s: uslsa_param: unsupported data rate, "
    472   1.1    dogcow 		       "forcing default of 115200bps\n",
    473   1.1    dogcow 		       USBDEVNAME(sc->sc_dev));
    474   1.1    dogcow 		data = USLSA_BPS(B115200);
    475   1.1    dogcow 	};
    476   1.1    dogcow 
    477   1.1    dogcow 	if (uslsa_request_set(sc, USLSA_REQ_SET_BPS, data))
    478   1.1    dogcow 		printf("%s: uslsa_param: setting data rate failed\n",
    479   1.1    dogcow 		       USBDEVNAME(sc->sc_dev));
    480   1.1    dogcow 
    481   1.1    dogcow 	data = 0;
    482   1.1    dogcow 
    483   1.1    dogcow 	if (ISSET(t->c_cflag, CSTOPB))
    484   1.1    dogcow 		data |= USLSA_DPS_STOP_TWO;
    485   1.1    dogcow 	else
    486   1.1    dogcow 		data |= USLSA_DPS_STOP_ONE;
    487   1.1    dogcow 
    488   1.1    dogcow 	if (ISSET(t->c_cflag, PARENB)) {
    489   1.1    dogcow 		if (ISSET(t->c_cflag, PARODD))
    490   1.1    dogcow 			data |= USLSA_DPS_PARITY_ODD;
    491   1.1    dogcow 		else
    492   1.1    dogcow 			data |= USLSA_DPS_PARITY_EVEN;
    493   1.1    dogcow 	} else
    494   1.1    dogcow 		data |= USLSA_DPS_PARITY_NONE;
    495   1.1    dogcow 
    496   1.1    dogcow 	switch (ISSET(t->c_cflag, CSIZE)) {
    497   1.1    dogcow 	case CS5:
    498   1.1    dogcow 		data |= USLSA_DPS_DATA_FIVE;
    499   1.1    dogcow 		break;
    500   1.1    dogcow 	case CS6:
    501   1.1    dogcow 		data |= USLSA_DPS_DATA_SIX;
    502   1.1    dogcow 		break;
    503   1.1    dogcow 	case CS7:
    504   1.1    dogcow 		data |= USLSA_DPS_DATA_SEVEN;
    505   1.1    dogcow 		break;
    506   1.1    dogcow 	case CS8:
    507   1.1    dogcow 		data |= USLSA_DPS_DATA_EIGHT;
    508   1.1    dogcow 		break;
    509   1.1    dogcow 	}
    510   1.1    dogcow 
    511   1.1    dogcow 	DPRINTF(("uslsa_param: setting DPS register to 0x%x\n", data));
    512   1.1    dogcow 	if (uslsa_request_set(sc, USLSA_REQ_SET_DPS, data))
    513   1.1    dogcow 		printf("%s: setting DPS register failed: invalid argument\n",
    514   1.1    dogcow 		       USBDEVNAME(sc->sc_dev));
    515   1.1    dogcow 
    516   1.1    dogcow 	uslsa_set_flow(sc, t->c_cflag, t->c_iflag);
    517   1.1    dogcow 
    518   1.1    dogcow 	return 0;
    519   1.1    dogcow }
    520   1.1    dogcow 
    521   1.1    dogcow 
    522   1.1    dogcow static int
    523   1.1    dogcow uslsa_open(void *vsc, int portno)
    524   1.1    dogcow {
    525   1.1    dogcow 	struct uslsa_softc *sc;
    526   1.1    dogcow 
    527   1.1    dogcow 	sc = vsc;
    528   1.1    dogcow 
    529   1.1    dogcow 	DPRINTF(("uslsa_open: sc=%p\n", sc));
    530   1.1    dogcow 
    531   1.1    dogcow 	if (sc->sc_dying)
    532   1.1    dogcow 		return (EIO);
    533   1.1    dogcow 
    534   1.1    dogcow 	if (uslsa_request_set(sc, USLSA_REQ_SET_STATE, USLSA_STATE_ENABLE))
    535   1.1    dogcow 		return (EIO);
    536   1.1    dogcow 
    537   1.1    dogcow 	return 0;
    538   1.1    dogcow }
    539   1.1    dogcow 
    540   1.1    dogcow void
    541   1.1    dogcow uslsa_close(void *vsc, int portno)
    542   1.1    dogcow {
    543   1.1    dogcow 	struct uslsa_softc *sc;
    544   1.1    dogcow 
    545   1.1    dogcow 	sc = vsc;
    546   1.1    dogcow 
    547   1.1    dogcow 	if (sc->sc_dying)
    548   1.1    dogcow 		return;
    549   1.1    dogcow 
    550   1.1    dogcow 	DPRINTF(("uslsa_close: sc=%p\n", sc));
    551   1.1    dogcow 
    552   1.1    dogcow 	if (uslsa_request_set(sc, USLSA_REQ_SET_STATE,
    553   1.1    dogcow 	    USLSA_STATE_DISABLE))
    554   1.1    dogcow 		printf("%s: disable-on-close failed\n",
    555   1.1    dogcow 		       USBDEVNAME(sc->sc_dev));
    556   1.1    dogcow }
    557   1.1    dogcow 
    558   1.1    dogcow /*
    559   1.1    dogcow  * uslsa_request_set(), wrapper for doing sets with usbd_do_request()
    560   1.1    dogcow  */
    561   1.1    dogcow static int
    562   1.1    dogcow uslsa_request_set(struct uslsa_softc * sc, uint8_t request, uint16_t value)
    563   1.1    dogcow {
    564   1.1    dogcow 	usb_device_request_t req;
    565   1.1    dogcow 	usbd_status err;
    566   1.1    dogcow 
    567   1.9  jakllsch 	req.bmRequestType = UT_WRITE_VENDOR_INTERFACE;
    568   1.1    dogcow 	req.bRequest = request;
    569   1.1    dogcow 	USETW(req.wValue, value);
    570   1.1    dogcow 	USETW(req.wIndex, 0);
    571   1.1    dogcow 	USETW(req.wLength, 0);
    572   1.1    dogcow 
    573   1.1    dogcow 	err = usbd_do_request(sc->sc_udev, &req, 0);
    574   1.1    dogcow 	if (err)
    575   1.1    dogcow 		printf("%s: uslsa_request: %s\n",
    576   1.1    dogcow 		       USBDEVNAME(sc->sc_dev), usbd_errstr(err));
    577   1.1    dogcow 	return err;
    578   1.1    dogcow }
    579   1.1    dogcow 
    580   1.1    dogcow /*
    581   1.1    dogcow  * uslsa_set_flow() does some magic to set up hardware flow control
    582   1.1    dogcow  */
    583   1.1    dogcow static void
    584   1.1    dogcow uslsa_set_flow(struct uslsa_softc *sc, tcflag_t cflag, tcflag_t iflag)
    585   1.1    dogcow {
    586   1.1    dogcow 	uint8_t mysterydata[16];
    587   1.1    dogcow 	usb_device_request_t req;
    588   1.1    dogcow 	usbd_status err;
    589   1.1    dogcow 
    590   1.1    dogcow 	DPRINTF(("uslsa_set_flow: cflag = 0x%x, iflag = 0x%x\n",
    591   1.1    dogcow 	         cflag, iflag));
    592   1.1    dogcow 
    593   1.9  jakllsch 	req.bmRequestType = UT_READ_VENDOR_INTERFACE;
    594   1.1    dogcow 	req.bRequest = USLSA_REQ_GET_MODEM;
    595   1.1    dogcow 	USETW(req.wValue, 0);
    596   1.1    dogcow 	USETW(req.wIndex, 0);
    597   1.1    dogcow 	USETW(req.wLength, 16);
    598   1.1    dogcow 
    599   1.1    dogcow 	err = usbd_do_request(sc->sc_udev, &req, mysterydata);
    600   1.1    dogcow 	if (err)
    601   1.1    dogcow 		printf("%s: uslsa_set_flow: %s\n",
    602   1.1    dogcow 		       USBDEVNAME(sc->sc_dev), usbd_errstr(err));
    603   1.1    dogcow 
    604   1.1    dogcow 	if (ISSET(cflag, CRTSCTS)) {
    605   1.1    dogcow 		mysterydata[0] &= ~0x7b;
    606   1.1    dogcow 		mysterydata[0] |= 0x09;
    607   1.1    dogcow 		mysterydata[4] = 0x80;
    608   1.1    dogcow 	} else {
    609   1.1    dogcow 		mysterydata[0] &= ~0x7b;
    610   1.1    dogcow 		mysterydata[0] |= 0x01;
    611   1.1    dogcow 		mysterydata[4] = 0x40;
    612   1.1    dogcow 	}
    613   1.1    dogcow 
    614   1.9  jakllsch 	req.bmRequestType = UT_WRITE_VENDOR_INTERFACE;
    615   1.1    dogcow 	req.bRequest = USLSA_REQ_SET_MODEM;
    616   1.1    dogcow 	USETW(req.wValue, 0);
    617   1.1    dogcow 	USETW(req.wIndex, 0);
    618   1.1    dogcow 	USETW(req.wLength, 16);
    619   1.1    dogcow 
    620   1.1    dogcow 	err = usbd_do_request(sc->sc_udev, &req, mysterydata);
    621   1.1    dogcow 	if (err)
    622   1.1    dogcow 		printf("%s: uslsa_set_flow: %s\n",
    623   1.1    dogcow 		       USBDEVNAME(sc->sc_dev), usbd_errstr(err));
    624   1.1    dogcow }
    625