Home | History | Annotate | Line # | Download | only in usb
uslsa.c revision 1.12.12.1
      1  1.12.12.1       mrg /* $NetBSD: uslsa.c,v 1.12.12.1 2012/02/18 07:35:12 mrg 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.2   xtraeme #include <sys/cdefs.h>
     61  1.12.12.1       mrg __KERNEL_RCSID(0, "$NetBSD: uslsa.c,v 1.12.12.1 2012/02/18 07:35:12 mrg Exp $");
     62        1.2   xtraeme 
     63        1.1    dogcow #include <sys/param.h>
     64        1.1    dogcow #include <sys/systm.h>
     65        1.1    dogcow #include <sys/kernel.h>
     66        1.1    dogcow #include <sys/device.h>
     67        1.1    dogcow #include <sys/conf.h>
     68        1.1    dogcow #include <sys/tty.h>
     69        1.1    dogcow 
     70        1.1    dogcow #include <dev/usb/usb.h>
     71        1.1    dogcow 
     72        1.1    dogcow #include <dev/usb/usbdi.h>
     73        1.1    dogcow #include <dev/usb/usbdi_util.h>
     74        1.1    dogcow #include <dev/usb/usbdevs.h>
     75        1.1    dogcow 
     76        1.1    dogcow #include <dev/usb/ucomvar.h>
     77        1.1    dogcow 
     78  1.12.12.1       mrg #include <dev/usb/uslsareg.h>
     79  1.12.12.1       mrg 
     80  1.12.12.1       mrg #include <fs/unicode.h>
     81        1.1    dogcow 
     82        1.1    dogcow #ifdef USLSA_DEBUG
     83  1.12.12.1       mrg #define DPRINTF(x)	if (uslsadebug) device_printf x
     84        1.1    dogcow int uslsadebug = 0;
     85        1.1    dogcow #else
     86        1.1    dogcow #define DPRINTF(x)
     87        1.1    dogcow #endif
     88        1.1    dogcow 
     89        1.1    dogcow struct uslsa_softc {
     90       1.12    dyoung 	device_t		sc_dev;		/* base device */
     91        1.5    dyoung 	device_t		sc_subdev;	/* ucom device */
     92  1.12.12.1       mrg 	usbd_device_handle	sc_udev;	/* usb device */
     93  1.12.12.1       mrg 	usbd_interface_handle	sc_iface;	/* interface */
     94  1.12.12.1       mrg 	uint8_t			sc_ifnum;	/* interface number */
     95  1.12.12.1       mrg 	bool			sc_dying;	/* disconnecting */
     96        1.1    dogcow };
     97        1.1    dogcow 
     98        1.1    dogcow static void uslsa_get_status(void *sc, int, u_char *, u_char *);
     99        1.1    dogcow static void uslsa_set(void *, int, int, int);
    100        1.1    dogcow static int uslsa_param(void *, int, struct termios *);
    101  1.12.12.1       mrg static int uslsa_ioctl(void *, int, u_long, void *, int, proc_t *);
    102  1.12.12.1       mrg 
    103        1.1    dogcow static int uslsa_open(void *, int);
    104        1.1    dogcow static void uslsa_close(void *, int);
    105        1.1    dogcow 
    106  1.12.12.1       mrg static int uslsa_usbd_errno(usbd_status);
    107        1.1    dogcow static int uslsa_request_set(struct uslsa_softc *, uint8_t, uint16_t);
    108  1.12.12.1       mrg static int uslsa_set_flow(struct uslsa_softc *, tcflag_t, tcflag_t);
    109        1.1    dogcow 
    110  1.12.12.1       mrg static const struct ucom_methods uslsa_methods = {
    111        1.1    dogcow 	uslsa_get_status,
    112        1.1    dogcow 	uslsa_set,
    113        1.1    dogcow 	uslsa_param,
    114  1.12.12.1       mrg 	uslsa_ioctl,
    115        1.1    dogcow 	uslsa_open,
    116        1.1    dogcow 	uslsa_close,
    117        1.1    dogcow 	NULL,
    118        1.1    dogcow 	NULL,
    119        1.1    dogcow };
    120        1.1    dogcow 
    121        1.1    dogcow #define USLSA_CONFIG_INDEX	0
    122        1.1    dogcow #define USLSA_IFACE_INDEX	0
    123        1.1    dogcow #define USLSA_BUFSIZE		256
    124        1.1    dogcow 
    125        1.1    dogcow static const struct usb_devno uslsa_devs[] = {
    126        1.1    dogcow         { USB_VENDOR_BALTECH,           USB_PRODUCT_BALTECH_CARDREADER },
    127        1.1    dogcow         { USB_VENDOR_DYNASTREAM,        USB_PRODUCT_DYNASTREAM_ANTDEVBOARD },
    128        1.1    dogcow         { USB_VENDOR_JABLOTRON,         USB_PRODUCT_JABLOTRON_PC60B },
    129        1.1    dogcow         { USB_VENDOR_SILABS,            USB_PRODUCT_SILABS_ARGUSISP },
    130        1.1    dogcow         { USB_VENDOR_SILABS,            USB_PRODUCT_SILABS_CRUMB128 },
    131        1.1    dogcow         { USB_VENDOR_SILABS,            USB_PRODUCT_SILABS_DEGREECONT },
    132        1.1    dogcow         { USB_VENDOR_SILABS,            USB_PRODUCT_SILABS_DESKTOPMOBILE },
    133        1.1    dogcow         { USB_VENDOR_SILABS,            USB_PRODUCT_SILABS_IPLINK1220 },
    134        1.1    dogcow         { USB_VENDOR_SILABS,            USB_PRODUCT_SILABS_LIPOWSKY_HARP },
    135        1.1    dogcow         { USB_VENDOR_SILABS,            USB_PRODUCT_SILABS_LIPOWSKY_JTAG },
    136        1.1    dogcow         { USB_VENDOR_SILABS,            USB_PRODUCT_SILABS_LIPOWSKY_LIN },
    137        1.1    dogcow         { USB_VENDOR_SILABS,            USB_PRODUCT_SILABS_POLOLU },
    138        1.1    dogcow         { USB_VENDOR_SILABS,            USB_PRODUCT_SILABS_CP210X_1 },
    139        1.1    dogcow         { USB_VENDOR_SILABS,            USB_PRODUCT_SILABS_CP210X_2 },
    140        1.1    dogcow         { USB_VENDOR_SILABS,            USB_PRODUCT_SILABS_SUNNTO },
    141        1.1    dogcow         { USB_VENDOR_SILABS2,           USB_PRODUCT_SILABS2_DCU11CLONE },
    142        1.1    dogcow         { USB_VENDOR_USI,               USB_PRODUCT_USI_MC60 }
    143        1.1    dogcow };
    144        1.1    dogcow 
    145  1.12.12.1       mrg static int uslsa_match(device_t, cfdata_t, void *);
    146  1.12.12.1       mrg static void uslsa_attach(device_t, device_t, void *);
    147  1.12.12.1       mrg static void uslsa_childdet(device_t, device_t);
    148  1.12.12.1       mrg static int uslsa_detach(device_t, int);
    149  1.12.12.1       mrg static int uslsa_activate(device_t, enum devact);
    150  1.12.12.1       mrg 
    151        1.8      cube CFATTACH_DECL2_NEW(uslsa, sizeof(struct uslsa_softc), uslsa_match,
    152        1.5    dyoung     uslsa_attach, uslsa_detach, uslsa_activate, NULL, uslsa_childdet);
    153        1.1    dogcow 
    154  1.12.12.1       mrg static int
    155       1.12    dyoung uslsa_match(device_t parent, cfdata_t match, void *aux)
    156        1.1    dogcow {
    157  1.12.12.1       mrg 	const struct usbif_attach_arg *uaa;
    158        1.1    dogcow 
    159  1.12.12.1       mrg 	uaa = aux;
    160  1.12.12.1       mrg 
    161  1.12.12.1       mrg 	if (usb_lookup(uslsa_devs, uaa->vendor, uaa->product) != NULL) {
    162  1.12.12.1       mrg 		return UMATCH_VENDOR_PRODUCT;
    163  1.12.12.1       mrg 	} else {
    164  1.12.12.1       mrg 		return UMATCH_NONE;
    165  1.12.12.1       mrg 	}
    166        1.1    dogcow }
    167        1.1    dogcow 
    168  1.12.12.1       mrg static void
    169       1.12    dyoung uslsa_attach(device_t parent, device_t self, void *aux)
    170        1.1    dogcow {
    171  1.12.12.1       mrg 	struct uslsa_softc *sc;
    172  1.12.12.1       mrg 	const struct usbif_attach_arg *uaa;
    173  1.12.12.1       mrg 	const usb_interface_descriptor_t *id;
    174  1.12.12.1       mrg 	const usb_endpoint_descriptor_t *ed;
    175        1.1    dogcow 	char *devinfop;
    176        1.1    dogcow 	struct ucom_attach_args uca;
    177        1.1    dogcow 	int i;
    178        1.1    dogcow 
    179  1.12.12.1       mrg 	sc = device_private(self);
    180  1.12.12.1       mrg 	uaa = aux;
    181        1.1    dogcow 
    182  1.12.12.1       mrg 	sc->sc_dev = self;
    183  1.12.12.1       mrg 	sc->sc_udev = uaa->device;
    184  1.12.12.1       mrg 	sc->sc_iface = uaa->iface;
    185        1.1    dogcow 
    186       1.10    plunky 	aprint_naive("\n");
    187       1.10    plunky 	aprint_normal("\n");
    188       1.10    plunky 
    189  1.12.12.1       mrg 	devinfop = usbd_devinfo_alloc(sc->sc_udev, 0);
    190       1.10    plunky 	aprint_normal_dev(self, "%s\n", devinfop);
    191       1.10    plunky 	usbd_devinfo_free(devinfop);
    192       1.10    plunky 
    193  1.12.12.1       mrg 	id = usbd_get_interface_descriptor(sc->sc_iface);
    194        1.1    dogcow 
    195  1.12.12.1       mrg 	sc->sc_ifnum = id->bInterfaceNumber;
    196        1.1    dogcow 
    197        1.1    dogcow 	uca.info = "Silicon Labs CP210x";
    198        1.3   nathanw 	uca.portno = UCOM_UNK_PORTNO;
    199        1.1    dogcow 	uca.ibufsize = USLSA_BUFSIZE;
    200        1.1    dogcow 	uca.obufsize = USLSA_BUFSIZE;
    201        1.1    dogcow 	uca.ibufsizepad = USLSA_BUFSIZE;
    202        1.1    dogcow 	uca.opkthdrlen = 0;
    203  1.12.12.1       mrg 	uca.device = sc->sc_udev;
    204  1.12.12.1       mrg 	uca.iface = sc->sc_iface;
    205        1.1    dogcow 	uca.methods = &uslsa_methods;
    206        1.1    dogcow 	uca.arg = sc;
    207        1.1    dogcow 
    208        1.1    dogcow 	usbd_add_drv_event(USB_EVENT_DRIVER_ATTACH, sc->sc_udev,
    209       1.12    dyoung 	                   sc->sc_dev);
    210        1.1    dogcow 
    211        1.1    dogcow 	uca.bulkin = uca.bulkout = -1;
    212        1.1    dogcow 	for (i = 0; i < id->bNumEndpoints; i++) {
    213        1.1    dogcow 		int addr, dir, attr;
    214        1.1    dogcow 
    215  1.12.12.1       mrg 		ed = usbd_interface2endpoint_descriptor(sc->sc_iface, i);
    216        1.1    dogcow 		if (ed == NULL) {
    217        1.8      cube 			aprint_error_dev(self,
    218  1.12.12.1       mrg 			    "could not read endpoint descriptor\n");
    219  1.12.12.1       mrg 			sc->sc_dying = true;
    220  1.12.12.1       mrg 			return;
    221        1.1    dogcow 		}
    222        1.1    dogcow 		addr = ed->bEndpointAddress;
    223        1.1    dogcow 		dir = UE_GET_DIR(ed->bEndpointAddress);
    224        1.1    dogcow 		attr = ed->bmAttributes & UE_XFERTYPE;
    225  1.12.12.1       mrg 		if (dir == UE_DIR_IN && attr == UE_BULK) {
    226        1.1    dogcow 			uca.bulkin = addr;
    227  1.12.12.1       mrg 		} else if (dir == UE_DIR_OUT && attr == UE_BULK) {
    228        1.1    dogcow 			uca.bulkout = addr;
    229  1.12.12.1       mrg 		} else {
    230        1.8      cube 			aprint_error_dev(self, "unexpected endpoint\n");
    231  1.12.12.1       mrg 		}
    232        1.1    dogcow 	}
    233  1.12.12.1       mrg 	aprint_debug_dev(sc->sc_dev, "EPs: in=%#x out=%#x\n",
    234  1.12.12.1       mrg 		uca.bulkin, uca.bulkout);
    235  1.12.12.1       mrg 	if ((uca.bulkin == -1) || (uca.bulkout == -1)) {
    236  1.12.12.1       mrg 		aprint_error_dev(self, "could not find endpoints\n");
    237  1.12.12.1       mrg 		sc->sc_dying = true;
    238  1.12.12.1       mrg 		return;
    239        1.1    dogcow 	}
    240        1.1    dogcow 
    241        1.1    dogcow 	sc->sc_subdev = config_found_sm_loc(self, "ucombus", NULL, &uca,
    242        1.1    dogcow 	                                    ucomprint, ucomsubmatch);
    243        1.1    dogcow 
    244       1.12    dyoung 	return;
    245        1.1    dogcow }
    246        1.1    dogcow 
    247  1.12.12.1       mrg static int
    248        1.5    dyoung uslsa_activate(device_t self, enum devact act)
    249        1.1    dogcow {
    250        1.5    dyoung 	struct uslsa_softc *sc = device_private(self);
    251        1.1    dogcow 
    252        1.1    dogcow 	switch (act) {
    253        1.1    dogcow 	case DVACT_DEACTIVATE:
    254  1.12.12.1       mrg 		sc->sc_dying = true;
    255       1.11    dyoung 		return 0;
    256       1.11    dyoung 	default:
    257       1.11    dyoung 		return EOPNOTSUPP;
    258        1.1    dogcow 	}
    259        1.1    dogcow }
    260        1.1    dogcow 
    261  1.12.12.1       mrg static void
    262        1.5    dyoung uslsa_childdet(device_t self, device_t child)
    263        1.5    dyoung {
    264        1.5    dyoung 	struct uslsa_softc *sc = device_private(self);
    265        1.5    dyoung 
    266        1.5    dyoung 	KASSERT(sc->sc_subdev == child);
    267        1.5    dyoung 	sc->sc_subdev = NULL;
    268        1.5    dyoung }
    269        1.5    dyoung 
    270  1.12.12.1       mrg static int
    271       1.12    dyoung uslsa_detach(device_t self, int flags)
    272        1.1    dogcow {
    273       1.12    dyoung 	struct uslsa_softc *sc = device_private(self);
    274        1.1    dogcow 	int rv = 0;
    275        1.1    dogcow 
    276  1.12.12.1       mrg 	DPRINTF((self, "%s(%p, %#x)\n", __func__, self, flags));
    277        1.1    dogcow 
    278  1.12.12.1       mrg 	sc->sc_dying = true;
    279        1.1    dogcow 
    280  1.12.12.1       mrg 	if (sc->sc_subdev != NULL) {
    281        1.1    dogcow 		rv = config_detach(sc->sc_subdev, flags);
    282  1.12.12.1       mrg 	}
    283        1.1    dogcow 
    284        1.1    dogcow 	usbd_add_drv_event(USB_EVENT_DRIVER_DETACH, sc->sc_udev,
    285       1.12    dyoung 	                   sc->sc_dev);
    286        1.1    dogcow 
    287        1.1    dogcow 	return (rv);
    288        1.1    dogcow }
    289        1.1    dogcow 
    290  1.12.12.1       mrg static int
    291  1.12.12.1       mrg uslsa_usbd_errno(usbd_status status)
    292  1.12.12.1       mrg {
    293  1.12.12.1       mrg 	switch (status) {
    294  1.12.12.1       mrg 	case USBD_NORMAL_COMPLETION:
    295  1.12.12.1       mrg 		return 0;
    296  1.12.12.1       mrg 	case USBD_STALLED:
    297  1.12.12.1       mrg 		return EINVAL;
    298  1.12.12.1       mrg 	default:
    299  1.12.12.1       mrg 		return EIO;
    300  1.12.12.1       mrg 	}
    301  1.12.12.1       mrg }
    302  1.12.12.1       mrg 
    303        1.1    dogcow static void
    304        1.1    dogcow uslsa_get_status(void *vsc, int portno, u_char *lsr, u_char *msr)
    305        1.1    dogcow {
    306        1.1    dogcow 	struct uslsa_softc *sc;
    307        1.1    dogcow 	usb_device_request_t req;
    308  1.12.12.1       mrg 	usbd_status status;
    309  1.12.12.1       mrg 	uint8_t mdmsts;
    310        1.1    dogcow 
    311        1.1    dogcow 	sc = vsc;
    312        1.1    dogcow 
    313  1.12.12.1       mrg 	DPRINTF((sc->sc_dev, "%s(%p, %d, ....)\n", __func__, vsc, portno));
    314  1.12.12.1       mrg 
    315  1.12.12.1       mrg 	if (sc->sc_dying) {
    316  1.12.12.1       mrg 		return;
    317  1.12.12.1       mrg 	}
    318        1.1    dogcow 
    319        1.9  jakllsch 	req.bmRequestType = UT_READ_VENDOR_INTERFACE;
    320  1.12.12.1       mrg 	req.bRequest = SLSA_R_GET_MDMSTS;
    321        1.1    dogcow 	USETW(req.wValue, 0);
    322  1.12.12.1       mrg 	USETW(req.wIndex, sc->sc_ifnum);
    323  1.12.12.1       mrg 	USETW(req.wLength, SLSA_RL_GET_MDMSTS);
    324  1.12.12.1       mrg 
    325  1.12.12.1       mrg 	status = usbd_do_request(sc->sc_udev, &req, &mdmsts);
    326  1.12.12.1       mrg 	if (status != USBD_NORMAL_COMPLETION) {
    327  1.12.12.1       mrg 		device_printf(sc->sc_dev, "%s: GET_MDMSTS %s\n",
    328  1.12.12.1       mrg 		    __func__, usbd_errstr(status));
    329  1.12.12.1       mrg 		return;
    330  1.12.12.1       mrg 	}
    331  1.12.12.1       mrg 
    332  1.12.12.1       mrg 	DPRINTF((sc->sc_dev, "%s: GET_MDMSTS %#x\n", __func__, mdmsts));
    333        1.1    dogcow 
    334  1.12.12.1       mrg 	if (lsr != NULL) {
    335  1.12.12.1       mrg 		*lsr = 0;
    336  1.12.12.1       mrg 	}
    337  1.12.12.1       mrg 
    338  1.12.12.1       mrg 	if (msr != NULL) {
    339  1.12.12.1       mrg 		*msr = 0;
    340  1.12.12.1       mrg 		*msr |= ISSET(mdmsts, SLSA_MDMSTS_CTS) ? UMSR_CTS : 0;
    341  1.12.12.1       mrg 		*msr |= ISSET(mdmsts, SLSA_MDMSTS_DSR) ? UMSR_DSR : 0;
    342  1.12.12.1       mrg 		*msr |= ISSET(mdmsts, SLSA_MDMSTS_RI) ? UMSR_RI : 0;
    343  1.12.12.1       mrg 		*msr |= ISSET(mdmsts, SLSA_MDMSTS_DCD) ? UMSR_DCD : 0;
    344  1.12.12.1       mrg 	}
    345        1.1    dogcow }
    346        1.1    dogcow 
    347        1.1    dogcow static void
    348        1.1    dogcow uslsa_set(void *vsc, int portno, int reg, int onoff)
    349        1.1    dogcow {
    350        1.1    dogcow 	struct uslsa_softc *sc;
    351        1.1    dogcow 
    352        1.1    dogcow 	sc = vsc;
    353        1.1    dogcow 
    354  1.12.12.1       mrg 	DPRINTF((sc->sc_dev, "%s(%p, %d, %d, %d)\n", __func__, vsc, portno, reg, onoff));
    355  1.12.12.1       mrg 
    356  1.12.12.1       mrg 	if (sc->sc_dying) {
    357  1.12.12.1       mrg 		return;
    358  1.12.12.1       mrg 	}
    359        1.1    dogcow 
    360        1.1    dogcow 	switch (reg) {
    361        1.1    dogcow 	case UCOM_SET_DTR:
    362  1.12.12.1       mrg 		if (uslsa_request_set(sc, SLSA_R_SET_MHS,
    363  1.12.12.1       mrg 		    SLSA_RV_SET_MHS_DTR_MASK |
    364  1.12.12.1       mrg 		    (onoff ? SLSA_RV_SET_MHS_DTR : 0))) {
    365  1.12.12.1       mrg 			device_printf(sc->sc_dev, "SET_MHS/DTR failed\n");
    366  1.12.12.1       mrg 		}
    367        1.1    dogcow 		break;
    368        1.1    dogcow 	case UCOM_SET_RTS:
    369  1.12.12.1       mrg 		if (uslsa_request_set(sc, SLSA_R_SET_MHS,
    370  1.12.12.1       mrg 		    SLSA_RV_SET_MHS_RTS_MASK |
    371  1.12.12.1       mrg 		    (onoff ? SLSA_RV_SET_MHS_RTS : 0))) {
    372  1.12.12.1       mrg 			device_printf(sc->sc_dev, "SET_MHS/RTS failed\n");
    373  1.12.12.1       mrg 		}
    374        1.1    dogcow 		break;
    375        1.1    dogcow 	case UCOM_SET_BREAK:
    376  1.12.12.1       mrg 		if (uslsa_request_set(sc, SLSA_R_SET_BREAK,
    377  1.12.12.1       mrg 		    (onoff ? SLSA_RV_SET_BREAK_ENABLE :
    378  1.12.12.1       mrg 		     SLSA_RV_SET_BREAK_DISABLE))) {
    379  1.12.12.1       mrg 			device_printf(sc->sc_dev, "SET_BREAK failed\n");
    380  1.12.12.1       mrg 		}
    381        1.1    dogcow 		break;
    382        1.1    dogcow 	default:
    383        1.1    dogcow 		break;
    384        1.1    dogcow 	}
    385        1.1    dogcow }
    386        1.1    dogcow 
    387        1.1    dogcow static int
    388  1.12.12.1       mrg uslsa_param(void *vsc, int portno, struct termios *t)
    389        1.1    dogcow {
    390        1.1    dogcow 	struct uslsa_softc *sc;
    391  1.12.12.1       mrg 	int ret;
    392  1.12.12.1       mrg 	uint16_t value;
    393        1.1    dogcow 
    394        1.1    dogcow 	sc = vsc;
    395        1.1    dogcow 
    396  1.12.12.1       mrg 	DPRINTF((sc->sc_dev, "%s(%p, %d, %p)\n", __func__, vsc, portno, t));
    397        1.1    dogcow 
    398  1.12.12.1       mrg 	if (sc->sc_dying) {
    399  1.12.12.1       mrg 		return EIO;
    400  1.12.12.1       mrg 	}
    401  1.12.12.1       mrg 
    402  1.12.12.1       mrg 	value = SLSA_RV_BAUDDIV(t->c_ospeed);
    403  1.12.12.1       mrg 
    404  1.12.12.1       mrg 	if ((ret = uslsa_request_set(sc, SLSA_R_SET_BAUDDIV, value)) != 0) {
    405  1.12.12.1       mrg 		device_printf(sc->sc_dev, "%s: SET_BAUDDIV failed\n",
    406  1.12.12.1       mrg 		       __func__);
    407  1.12.12.1       mrg 		return ret;
    408  1.12.12.1       mrg 	}
    409  1.12.12.1       mrg 
    410  1.12.12.1       mrg 	value = 0;
    411  1.12.12.1       mrg 
    412  1.12.12.1       mrg 	if (ISSET(t->c_cflag, CSTOPB)) {
    413  1.12.12.1       mrg 		value |= SLSA_RV_LINE_CTL_STOP_2;
    414  1.12.12.1       mrg 	} else {
    415  1.12.12.1       mrg 		value |= SLSA_RV_LINE_CTL_STOP_1;
    416  1.12.12.1       mrg 	}
    417        1.1    dogcow 
    418        1.1    dogcow 	if (ISSET(t->c_cflag, PARENB)) {
    419  1.12.12.1       mrg 		if (ISSET(t->c_cflag, PARODD)) {
    420  1.12.12.1       mrg 			value |= SLSA_RV_LINE_CTL_PARITY_ODD;
    421  1.12.12.1       mrg 		} else {
    422  1.12.12.1       mrg 			value |= SLSA_RV_LINE_CTL_PARITY_EVEN;
    423  1.12.12.1       mrg 		}
    424  1.12.12.1       mrg 	} else {
    425  1.12.12.1       mrg 		value |= SLSA_RV_LINE_CTL_PARITY_NONE;
    426  1.12.12.1       mrg 	}
    427        1.1    dogcow 
    428        1.1    dogcow 	switch (ISSET(t->c_cflag, CSIZE)) {
    429        1.1    dogcow 	case CS5:
    430  1.12.12.1       mrg 		value |= SLSA_RV_LINE_CTL_LEN_5;
    431        1.1    dogcow 		break;
    432        1.1    dogcow 	case CS6:
    433  1.12.12.1       mrg 		value |= SLSA_RV_LINE_CTL_LEN_6;
    434        1.1    dogcow 		break;
    435        1.1    dogcow 	case CS7:
    436  1.12.12.1       mrg 		value |= SLSA_RV_LINE_CTL_LEN_7;
    437        1.1    dogcow 		break;
    438        1.1    dogcow 	case CS8:
    439  1.12.12.1       mrg 		value |= SLSA_RV_LINE_CTL_LEN_8;
    440        1.1    dogcow 		break;
    441        1.1    dogcow 	}
    442        1.1    dogcow 
    443  1.12.12.1       mrg 	DPRINTF((sc->sc_dev, "%s: setting LINE_CTL to 0x%x\n",
    444  1.12.12.1       mrg 	    __func__, value));
    445  1.12.12.1       mrg 	if ((ret = uslsa_request_set(sc, SLSA_R_SET_LINE_CTL, value)) != 0) {
    446  1.12.12.1       mrg 		device_printf(sc->sc_dev, "SET_LINE_CTL failed\n");
    447  1.12.12.1       mrg 		return ret;
    448  1.12.12.1       mrg 	}
    449        1.1    dogcow 
    450  1.12.12.1       mrg 	if ((ret = uslsa_set_flow(sc, t->c_cflag, t->c_iflag)) != 0) {
    451  1.12.12.1       mrg 		device_printf(sc->sc_dev, "SET_LINE_CTL failed\n");
    452  1.12.12.1       mrg 	}
    453        1.1    dogcow 
    454  1.12.12.1       mrg 	return ret;
    455        1.1    dogcow }
    456        1.1    dogcow 
    457  1.12.12.1       mrg static int
    458  1.12.12.1       mrg uslsa_ioctl(void *vsc, int portno, u_long cmd, void *data, int flag, proc_t *p)
    459  1.12.12.1       mrg {
    460  1.12.12.1       mrg 	struct uslsa_softc *sc;
    461  1.12.12.1       mrg 
    462  1.12.12.1       mrg 	sc = vsc;
    463  1.12.12.1       mrg 
    464  1.12.12.1       mrg 	switch (cmd) {
    465  1.12.12.1       mrg 	case TIOCMGET:
    466  1.12.12.1       mrg 		ucom_status_change(device_private(sc->sc_subdev));
    467  1.12.12.1       mrg 		return EPASSTHROUGH;
    468  1.12.12.1       mrg 	default:
    469  1.12.12.1       mrg 		return EPASSTHROUGH;
    470  1.12.12.1       mrg 	}
    471  1.12.12.1       mrg 
    472  1.12.12.1       mrg 	return 0;
    473  1.12.12.1       mrg }
    474        1.1    dogcow 
    475        1.1    dogcow static int
    476        1.1    dogcow uslsa_open(void *vsc, int portno)
    477        1.1    dogcow {
    478        1.1    dogcow 	struct uslsa_softc *sc;
    479        1.1    dogcow 
    480        1.1    dogcow 	sc = vsc;
    481        1.1    dogcow 
    482  1.12.12.1       mrg 	DPRINTF((sc->sc_dev, "%s(%p, %d)\n", __func__, vsc, portno));
    483        1.1    dogcow 
    484  1.12.12.1       mrg 	if (sc->sc_dying) {
    485  1.12.12.1       mrg 		return EIO;
    486  1.12.12.1       mrg 	}
    487        1.1    dogcow 
    488  1.12.12.1       mrg 	return uslsa_request_set(sc, SLSA_R_IFC_ENABLE,
    489  1.12.12.1       mrg 	    SLSA_RV_IFC_ENABLE_ENABLE);
    490        1.1    dogcow }
    491        1.1    dogcow 
    492  1.12.12.1       mrg static void
    493        1.1    dogcow uslsa_close(void *vsc, int portno)
    494        1.1    dogcow {
    495        1.1    dogcow 	struct uslsa_softc *sc;
    496        1.1    dogcow 
    497        1.1    dogcow 	sc = vsc;
    498        1.1    dogcow 
    499  1.12.12.1       mrg 	DPRINTF((sc->sc_dev, "%s(%p, %d)\n", __func__, vsc, portno));
    500        1.1    dogcow 
    501  1.12.12.1       mrg 	if (sc->sc_dying) {
    502  1.12.12.1       mrg 		return;
    503  1.12.12.1       mrg 	}
    504        1.1    dogcow 
    505  1.12.12.1       mrg 	(void)uslsa_request_set(sc, SLSA_R_IFC_ENABLE,
    506  1.12.12.1       mrg 	    SLSA_RV_IFC_ENABLE_DISABLE);
    507        1.1    dogcow }
    508        1.1    dogcow 
    509        1.1    dogcow static int
    510        1.1    dogcow uslsa_request_set(struct uslsa_softc * sc, uint8_t request, uint16_t value)
    511        1.1    dogcow {
    512        1.1    dogcow 	usb_device_request_t req;
    513  1.12.12.1       mrg 	usbd_status status;
    514        1.1    dogcow 
    515        1.9  jakllsch 	req.bmRequestType = UT_WRITE_VENDOR_INTERFACE;
    516        1.1    dogcow 	req.bRequest = request;
    517        1.1    dogcow 	USETW(req.wValue, value);
    518  1.12.12.1       mrg 	USETW(req.wIndex, sc->sc_ifnum);
    519        1.1    dogcow 	USETW(req.wLength, 0);
    520        1.1    dogcow 
    521  1.12.12.1       mrg 	status = usbd_do_request(sc->sc_udev, &req, NULL);
    522  1.12.12.1       mrg 
    523  1.12.12.1       mrg 	return uslsa_usbd_errno(status);
    524        1.1    dogcow }
    525        1.1    dogcow 
    526  1.12.12.1       mrg static int
    527        1.1    dogcow uslsa_set_flow(struct uslsa_softc *sc, tcflag_t cflag, tcflag_t iflag)
    528        1.1    dogcow {
    529  1.12.12.1       mrg 	struct slsa_fcs fcs;
    530        1.1    dogcow 	usb_device_request_t req;
    531  1.12.12.1       mrg 	uint32_t ulControlHandshake;
    532  1.12.12.1       mrg 	uint32_t ulFlowReplace;
    533  1.12.12.1       mrg 	usbd_status status;
    534        1.1    dogcow 
    535  1.12.12.1       mrg 	DPRINTF((sc->sc_dev, "%s(%p, %#x, %#x)\n", __func__, sc, cflag, iflag));
    536        1.1    dogcow 
    537        1.9  jakllsch 	req.bmRequestType = UT_READ_VENDOR_INTERFACE;
    538  1.12.12.1       mrg 	req.bRequest = SLSA_R_GET_FLOW;
    539        1.1    dogcow 	USETW(req.wValue, 0);
    540  1.12.12.1       mrg 	USETW(req.wIndex, sc->sc_ifnum);
    541  1.12.12.1       mrg 	USETW(req.wLength, SLSA_RL_GET_FLOW);
    542  1.12.12.1       mrg 
    543  1.12.12.1       mrg 	status = usbd_do_request(sc->sc_udev, &req, &fcs);
    544  1.12.12.1       mrg 	if (status != USBD_NORMAL_COMPLETION) {
    545  1.12.12.1       mrg 		device_printf(sc->sc_dev, "%s: GET_FLOW %s\n",
    546  1.12.12.1       mrg 			__func__, usbd_errstr(status));
    547  1.12.12.1       mrg 		return uslsa_usbd_errno(status);
    548  1.12.12.1       mrg 	}
    549        1.1    dogcow 
    550  1.12.12.1       mrg 	ulControlHandshake = le32toh(fcs.ulControlHandshake);
    551  1.12.12.1       mrg 	ulFlowReplace = le32toh(fcs.ulFlowReplace);
    552        1.1    dogcow 
    553        1.1    dogcow 	if (ISSET(cflag, CRTSCTS)) {
    554  1.12.12.1       mrg 		ulControlHandshake =
    555  1.12.12.1       mrg 		    SERIAL_CTS_HANDSHAKE | __SHIFTIN(1, SERIAL_DTR_MASK);
    556  1.12.12.1       mrg 		ulFlowReplace = __SHIFTIN(2, SERIAL_RTS_MASK);
    557        1.1    dogcow 	} else {
    558  1.12.12.1       mrg 		ulControlHandshake = __SHIFTIN(1, SERIAL_DTR_MASK);
    559  1.12.12.1       mrg 		ulFlowReplace = __SHIFTIN(1, SERIAL_RTS_MASK);
    560        1.1    dogcow 	}
    561        1.1    dogcow 
    562  1.12.12.1       mrg 	fcs.ulControlHandshake = htole32(ulControlHandshake);
    563  1.12.12.1       mrg 	fcs.ulFlowReplace = htole32(ulFlowReplace);
    564  1.12.12.1       mrg 
    565        1.9  jakllsch 	req.bmRequestType = UT_WRITE_VENDOR_INTERFACE;
    566  1.12.12.1       mrg 	req.bRequest = SLSA_R_SET_FLOW;
    567        1.1    dogcow 	USETW(req.wValue, 0);
    568  1.12.12.1       mrg 	USETW(req.wIndex, sc->sc_ifnum);
    569  1.12.12.1       mrg 	USETW(req.wLength, SLSA_RL_SET_FLOW);
    570  1.12.12.1       mrg 
    571  1.12.12.1       mrg 	status = usbd_do_request(sc->sc_udev, &req, &fcs);
    572        1.1    dogcow 
    573  1.12.12.1       mrg 	return uslsa_usbd_errno(status);
    574        1.1    dogcow }
    575