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