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