Home | History | Annotate | Line # | Download | only in usb
uftdi.c revision 1.70.2.1
      1 /*	$NetBSD: uftdi.c,v 1.70.2.1 2024/04/28 13:29:40 martin Exp $	*/
      2 
      3 /*
      4  * Copyright (c) 2000 The NetBSD Foundation, Inc.
      5  * All rights reserved.
      6  *
      7  * This code is derived from software contributed to The NetBSD Foundation
      8  * by Lennart Augustsson (lennart (at) augustsson.net).
      9  *
     10  * Redistribution and use in source and binary forms, with or without
     11  * modification, are permitted provided that the following conditions
     12  * are met:
     13  * 1. Redistributions of source code must retain the above copyright
     14  *    notice, this list of conditions and the following disclaimer.
     15  * 2. Redistributions in binary form must reproduce the above copyright
     16  *    notice, this list of conditions and the following disclaimer in the
     17  *    documentation and/or other materials provided with the distribution.
     18  *
     19  * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
     20  * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
     21  * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
     22  * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
     23  * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
     24  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
     25  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
     26  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
     27  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
     28  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
     29  * POSSIBILITY OF SUCH DAMAGE.
     30  */
     31 
     32 #include <sys/cdefs.h>
     33 __KERNEL_RCSID(0, "$NetBSD: uftdi.c,v 1.70.2.1 2024/04/28 13:29:40 martin Exp $");
     34 
     35 #ifdef _KERNEL_OPT
     36 #include "opt_usb.h"
     37 #endif
     38 
     39 #include <sys/param.h>
     40 #include <sys/systm.h>
     41 #include <sys/kernel.h>
     42 #include <sys/device.h>
     43 #include <sys/conf.h>
     44 #include <sys/tty.h>
     45 
     46 #include <dev/usb/usb.h>
     47 
     48 #include <dev/usb/usbdi.h>
     49 #include <dev/usb/usbdi_util.h>
     50 #include <dev/usb/usbdevs.h>
     51 
     52 #include <dev/usb/ucomvar.h>
     53 
     54 #include <dev/usb/uftdireg.h>
     55 
     56 #ifdef UFTDI_DEBUG
     57 #define DPRINTF(x)	if (uftdidebug) printf x
     58 #define DPRINTFN(n,x)	if (uftdidebug>(n)) printf x
     59 int uftdidebug = 0;
     60 #else
     61 #define DPRINTF(x)
     62 #define DPRINTFN(n,x)
     63 #endif
     64 
     65 #define UFTDI_CONFIG_NO		1
     66 
     67 /*
     68  * These are the default number of bytes transferred per frame if the
     69  * endpoint doesn't tell us.  The output buffer size is a hard limit
     70  * for devices that use a 6-bit size encoding.
     71  */
     72 #define UFTDIIBUFSIZE 64
     73 #define UFTDIOBUFSIZE 64
     74 
     75 /*
     76  * Magic constants!  Where do these come from?  They're what Linux uses...
     77  */
     78 #define	UFTDI_MAX_IBUFSIZE	512
     79 #define	UFTDI_MAX_OBUFSIZE	256
     80 
     81 struct uftdi_softc {
     82 	device_t		sc_dev;		/* base device */
     83 	struct usbd_device *	sc_udev;	/* device */
     84 	struct usbd_interface *	sc_iface;	/* interface */
     85 	int			sc_iface_no;
     86 
     87 	enum uftdi_type		sc_type;
     88 	u_int			sc_hdrlen;
     89 	u_int			sc_chiptype;
     90 
     91 	u_char			sc_msr;
     92 	u_char			sc_lsr;
     93 
     94 	device_t		sc_subdev;
     95 
     96 	bool			sc_dying;
     97 
     98 	u_int			last_lcr;
     99 
    100 };
    101 
    102 static void	uftdi_get_status(void *, int, u_char *, u_char *);
    103 static void	uftdi_set(void *, int, int, int);
    104 static int	uftdi_param(void *, int, struct termios *);
    105 static int	uftdi_open(void *, int);
    106 static void	uftdi_read(void *, int, u_char **, uint32_t *);
    107 static void	uftdi_write(void *, int, u_char *, u_char *, uint32_t *);
    108 static void	uftdi_break(void *, int, int);
    109 
    110 struct ucom_methods uftdi_methods = {
    111 	.ucom_get_status = uftdi_get_status,
    112 	.ucom_set = uftdi_set,
    113 	.ucom_param = uftdi_param,
    114 	.ucom_open = uftdi_open,
    115 	.ucom_read = uftdi_read,
    116 	.ucom_write = uftdi_write,
    117 };
    118 
    119 /*
    120  * The devices default to UFTDI_TYPE_8U232AM.
    121  * Remember to update uftdi_attach() if it should be UFTDI_TYPE_SIO instead
    122  */
    123 static const struct usb_devno uftdi_devs[] = {
    124 	{ USB_VENDOR_BBELECTRONICS, USB_PRODUCT_BBELECTRONICS_USOTL4 },
    125 	{ USB_VENDOR_BRAINBOXES, USB_PRODUCT_BRAINBOXES_US101 },
    126 	{ USB_VENDOR_BRAINBOXES, USB_PRODUCT_BRAINBOXES_US159 },
    127 	{ USB_VENDOR_BRAINBOXES, USB_PRODUCT_BRAINBOXES_US235 },
    128 	{ USB_VENDOR_BRAINBOXES, USB_PRODUCT_BRAINBOXES_US257 },
    129 	{ USB_VENDOR_BRAINBOXES, USB_PRODUCT_BRAINBOXES_US279_12 },
    130 	{ USB_VENDOR_BRAINBOXES, USB_PRODUCT_BRAINBOXES_US279_34 },
    131 	{ USB_VENDOR_BRAINBOXES, USB_PRODUCT_BRAINBOXES_US279_56 },
    132 	{ USB_VENDOR_BRAINBOXES, USB_PRODUCT_BRAINBOXES_US279_78 },
    133 	{ USB_VENDOR_BRAINBOXES, USB_PRODUCT_BRAINBOXES_US313 },
    134 	{ USB_VENDOR_BRAINBOXES, USB_PRODUCT_BRAINBOXES_US320 },
    135 	{ USB_VENDOR_BRAINBOXES, USB_PRODUCT_BRAINBOXES_US324 },
    136 	{ USB_VENDOR_BRAINBOXES, USB_PRODUCT_BRAINBOXES_US346_12 },
    137 	{ USB_VENDOR_BRAINBOXES, USB_PRODUCT_BRAINBOXES_US346_34 },
    138 	{ USB_VENDOR_BRAINBOXES, USB_PRODUCT_BRAINBOXES_US701_12 },
    139 	{ USB_VENDOR_BRAINBOXES, USB_PRODUCT_BRAINBOXES_US701_34 },
    140 	{ USB_VENDOR_BRAINBOXES, USB_PRODUCT_BRAINBOXES_US842_12 },
    141 	{ USB_VENDOR_BRAINBOXES, USB_PRODUCT_BRAINBOXES_US842_34 },
    142 	{ USB_VENDOR_BRAINBOXES, USB_PRODUCT_BRAINBOXES_US842_56 },
    143 	{ USB_VENDOR_BRAINBOXES, USB_PRODUCT_BRAINBOXES_US842_78 },
    144 	{ USB_VENDOR_FALCOM, USB_PRODUCT_FALCOM_TWIST },
    145 	{ USB_VENDOR_FALCOM, USB_PRODUCT_FALCOM_SAMBA },
    146 	{ USB_VENDOR_FTDI, USB_PRODUCT_FTDI_SERIAL_230X },
    147 	{ USB_VENDOR_FTDI, USB_PRODUCT_FTDI_SERIAL_232H },
    148 	{ USB_VENDOR_FTDI, USB_PRODUCT_FTDI_SERIAL_232RL },
    149 	{ USB_VENDOR_FTDI, USB_PRODUCT_FTDI_SERIAL_2232C },
    150 	{ USB_VENDOR_FTDI, USB_PRODUCT_FTDI_SERIAL_4232H },
    151 	{ USB_VENDOR_FTDI, USB_PRODUCT_FTDI_SERIAL_8U100AX },
    152 	{ USB_VENDOR_FTDI, USB_PRODUCT_FTDI_SERIAL_8U232AM },
    153 	{ USB_VENDOR_FTDI, USB_PRODUCT_FTDI_MHAM_KW },
    154 	{ USB_VENDOR_FTDI, USB_PRODUCT_FTDI_MHAM_YS },
    155 	{ USB_VENDOR_FTDI, USB_PRODUCT_FTDI_MHAM_Y6 },
    156 	{ USB_VENDOR_FTDI, USB_PRODUCT_FTDI_MHAM_Y8 },
    157 	{ USB_VENDOR_FTDI, USB_PRODUCT_FTDI_MHAM_IC },
    158 	{ USB_VENDOR_FTDI, USB_PRODUCT_FTDI_MHAM_DB9 },
    159 	{ USB_VENDOR_FTDI, USB_PRODUCT_FTDI_MHAM_RS232 },
    160 	{ USB_VENDOR_FTDI, USB_PRODUCT_FTDI_MHAM_Y9 },
    161 	{ USB_VENDOR_FTDI, USB_PRODUCT_FTDI_COASTAL_TNCX },
    162 	{ USB_VENDOR_FTDI, USB_PRODUCT_FTDI_CTI_485_MINI },
    163 	{ USB_VENDOR_FTDI, USB_PRODUCT_FTDI_CTI_NANO_485 },
    164 	{ USB_VENDOR_FTDI, USB_PRODUCT_FTDI_SEMC_DSS20 },
    165 	{ USB_VENDOR_FTDI, USB_PRODUCT_FTDI_LCD_LK202_24_USB },
    166 	{ USB_VENDOR_FTDI, USB_PRODUCT_FTDI_LCD_LK204_24_USB },
    167 	{ USB_VENDOR_FTDI, USB_PRODUCT_FTDI_LCD_MX200_USB },
    168 	{ USB_VENDOR_FTDI, USB_PRODUCT_FTDI_LCD_MX4_MX5_USB },
    169 	{ USB_VENDOR_FTDI, USB_PRODUCT_FTDI_LCD_CFA_631 },
    170 	{ USB_VENDOR_FTDI, USB_PRODUCT_FTDI_LCD_CFA_632 },
    171 	{ USB_VENDOR_FTDI, USB_PRODUCT_FTDI_LCD_CFA_633 },
    172 	{ USB_VENDOR_FTDI, USB_PRODUCT_FTDI_LCD_CFA_634 },
    173 	{ USB_VENDOR_FTDI, USB_PRODUCT_FTDI_LCD_CFA_635 },
    174 	{ USB_VENDOR_FTDI, USB_PRODUCT_FTDI_OPENRD_JTAGKEY },
    175 	{ USB_VENDOR_FTDI, USB_PRODUCT_FTDI_BEAGLEBONE },
    176 	{ USB_VENDOR_FTDI, USB_PRODUCT_FTDI_MAXSTREAM_PKG_U },
    177 	{ USB_VENDOR_xxFTDI, USB_PRODUCT_xxFTDI_SHEEVAPLUG_JTAG },
    178 	{ USB_VENDOR_INTREPIDCS, USB_PRODUCT_INTREPIDCS_VALUECAN },
    179 	{ USB_VENDOR_INTREPIDCS, USB_PRODUCT_INTREPIDCS_NEOVI },
    180 	{ USB_VENDOR_MELCO, USB_PRODUCT_MELCO_PCOPRS1 },
    181 	{ USB_VENDOR_RATOC, USB_PRODUCT_RATOC_REXUSB60F },
    182 	{ USB_VENDOR_RTSYS, USB_PRODUCT_RTSYS_CT57A },
    183 	{ USB_VENDOR_RTSYS, USB_PRODUCT_RTSYS_RTS03 },
    184 	{ USB_VENDOR_SEALEVEL, USB_PRODUCT_SEALEVEL_USBSERIAL },
    185 	{ USB_VENDOR_SEALEVEL, USB_PRODUCT_SEALEVEL_SEAPORT4P1 },
    186 	{ USB_VENDOR_SEALEVEL, USB_PRODUCT_SEALEVEL_SEAPORT4P2 },
    187 	{ USB_VENDOR_SEALEVEL, USB_PRODUCT_SEALEVEL_SEAPORT4P3 },
    188 	{ USB_VENDOR_SEALEVEL, USB_PRODUCT_SEALEVEL_SEAPORT4P4 },
    189 	{ USB_VENDOR_SIIG2, USB_PRODUCT_SIIG2_US2308 },
    190 	{ USB_VENDOR_MISC, USB_PRODUCT_MISC_TELLSTICK },
    191 	{ USB_VENDOR_MISC, USB_PRODUCT_MISC_TELLSTICK_DUO },
    192 };
    193 #define uftdi_lookup(v, p) usb_lookup(uftdi_devs, v, p)
    194 
    195 static int	uftdi_match(device_t, cfdata_t, void *);
    196 static void	uftdi_attach(device_t, device_t, void *);
    197 static void	uftdi_childdet(device_t, device_t);
    198 static int	uftdi_detach(device_t, int);
    199 
    200 CFATTACH_DECL2_NEW(uftdi, sizeof(struct uftdi_softc), uftdi_match,
    201     uftdi_attach, uftdi_detach, NULL, NULL, uftdi_childdet);
    202 
    203 static int
    204 uftdi_match(device_t parent, cfdata_t match, void *aux)
    205 {
    206 	struct usbif_attach_arg *uiaa = aux;
    207 
    208 	DPRINTFN(20,("uftdi: vendor=0x%x, product=0x%x\n",
    209 		     uiaa->uiaa_vendor, uiaa->uiaa_product));
    210 
    211 	if (uiaa->uiaa_configno != UFTDI_CONFIG_NO)
    212 		return UMATCH_NONE;
    213 
    214 	return uftdi_lookup(uiaa->uiaa_vendor, uiaa->uiaa_product) != NULL ?
    215 		UMATCH_VENDOR_PRODUCT_CONF_IFACE : UMATCH_NONE;
    216 }
    217 
    218 static void
    219 uftdi_attach(device_t parent, device_t self, void *aux)
    220 {
    221 	struct uftdi_softc *sc = device_private(self);
    222 	struct usbif_attach_arg *uiaa = aux;
    223 	struct usbd_device *dev = uiaa->uiaa_device;
    224 	struct usbd_interface *iface = uiaa->uiaa_iface;
    225 	usb_device_descriptor_t *ddesc;
    226 	usb_interface_descriptor_t *id;
    227 	usb_endpoint_descriptor_t *ed;
    228 	char *devinfop;
    229 	int i;
    230 	struct ucom_attach_args ucaa;
    231 
    232 	DPRINTFN(10,("\nuftdi_attach: sc=%p\n", sc));
    233 
    234 	aprint_naive("\n");
    235 	aprint_normal("\n");
    236 
    237 	devinfop = usbd_devinfo_alloc(dev, 0);
    238 	aprint_normal_dev(self, "%s\n", devinfop);
    239 	usbd_devinfo_free(devinfop);
    240 
    241 	sc->sc_dev = self;
    242 	sc->sc_udev = dev;
    243 	sc->sc_dying = false;
    244 	sc->sc_iface_no = uiaa->uiaa_ifaceno;
    245 	sc->sc_type = UFTDI_TYPE_8U232AM; /* most devices are post-8U232AM */
    246 	sc->sc_hdrlen = 0;
    247 	if (uiaa->uiaa_vendor == USB_VENDOR_FTDI
    248 	    && uiaa->uiaa_product == USB_PRODUCT_FTDI_SERIAL_8U100AX) {
    249 		sc->sc_type = UFTDI_TYPE_SIO;
    250 		sc->sc_hdrlen = 1;
    251 	}
    252 
    253 	ddesc = usbd_get_device_descriptor(dev);
    254 	sc->sc_chiptype = UGETW(ddesc->bcdDevice);
    255 
    256 	id = usbd_get_interface_descriptor(iface);
    257 
    258 	sc->sc_iface = iface;
    259 
    260 	ucaa.ucaa_bulkin = ucaa.ucaa_bulkout = -1;
    261 	ucaa.ucaa_ibufsize = ucaa.ucaa_obufsize = 0;
    262 	for (i = 0; i < id->bNumEndpoints; i++) {
    263 		int addr, dir, attr;
    264 		ed = usbd_interface2endpoint_descriptor(iface, i);
    265 		if (ed == NULL) {
    266 			aprint_error_dev(self,
    267 			    "could not read endpoint descriptor\n");
    268 			goto bad;
    269 		}
    270 
    271 		addr = ed->bEndpointAddress;
    272 		dir = UE_GET_DIR(ed->bEndpointAddress);
    273 		attr = ed->bmAttributes & UE_XFERTYPE;
    274 		if (dir == UE_DIR_IN && attr == UE_BULK) {
    275 			ucaa.ucaa_bulkin = addr;
    276 			ucaa.ucaa_ibufsize = UGETW(ed->wMaxPacketSize);
    277 			if (ucaa.ucaa_ibufsize >= UFTDI_MAX_IBUFSIZE)
    278 				ucaa.ucaa_ibufsize = UFTDI_MAX_IBUFSIZE;
    279 		} else if (dir == UE_DIR_OUT && attr == UE_BULK) {
    280 			ucaa.ucaa_bulkout = addr;
    281 			ucaa.ucaa_obufsize = UGETW(ed->wMaxPacketSize)
    282 			    - sc->sc_hdrlen;
    283 			if (ucaa.ucaa_obufsize >= UFTDI_MAX_OBUFSIZE)
    284 				ucaa.ucaa_obufsize = UFTDI_MAX_OBUFSIZE;
    285 			/* Limit length if we have a 6-bit header.  */
    286 			if ((sc->sc_hdrlen > 0) &&
    287 			    (ucaa.ucaa_obufsize > UFTDIOBUFSIZE))
    288 				ucaa.ucaa_obufsize = UFTDIOBUFSIZE;
    289 		} else {
    290 			aprint_error_dev(self, "unexpected endpoint\n");
    291 			goto bad;
    292 		}
    293 	}
    294 	if (ucaa.ucaa_bulkin == -1) {
    295 		aprint_error_dev(self, "Could not find data bulk in\n");
    296 		goto bad;
    297 	}
    298 	if (ucaa.ucaa_bulkout == -1) {
    299 		aprint_error_dev(self, "Could not find data bulk out\n");
    300 		goto bad;
    301 	}
    302 
    303 	ucaa.ucaa_portno = FTDI_PIT_SIOA + sc->sc_iface_no;
    304 	/* ucaa_bulkin, ucaa_bulkout set above */
    305 	if (ucaa.ucaa_ibufsize == 0)
    306 		ucaa.ucaa_ibufsize = UFTDIIBUFSIZE;
    307 	ucaa.ucaa_ibufsizepad = ucaa.ucaa_ibufsize;
    308 	if (ucaa.ucaa_obufsize == 0)
    309 		ucaa.ucaa_obufsize = UFTDIOBUFSIZE - sc->sc_hdrlen;
    310 	ucaa.ucaa_opkthdrlen = sc->sc_hdrlen;
    311 	ucaa.ucaa_device = dev;
    312 	ucaa.ucaa_iface = iface;
    313 	ucaa.ucaa_methods = &uftdi_methods;
    314 	ucaa.ucaa_arg = sc;
    315 	ucaa.ucaa_info = NULL;
    316 
    317 	DPRINTF(("uftdi: in=0x%x out=0x%x isize=0x%x osize=0x%x\n",
    318 		ucaa.ucaa_bulkin, ucaa.ucaa_bulkout,
    319 		ucaa.ucaa_ibufsize, ucaa.ucaa_obufsize));
    320 	sc->sc_subdev = config_found_sm_loc(self, "ucombus", NULL,
    321 	    &ucaa, ucomprint, ucomsubmatch);
    322 
    323 	usbd_add_drv_event(USB_EVENT_DRIVER_ATTACH, sc->sc_udev, sc->sc_dev);
    324 
    325 	if (!pmf_device_register(self, NULL, NULL))
    326 		aprint_error_dev(self, "couldn't establish power handler\n");
    327 
    328 	return;
    329 
    330 bad:
    331 	DPRINTF(("uftdi_attach: ATTACH ERROR\n"));
    332 	sc->sc_dying = true;
    333 	return;
    334 }
    335 
    336 static void
    337 uftdi_childdet(device_t self, device_t child)
    338 {
    339 	struct uftdi_softc *sc = device_private(self);
    340 
    341 	KASSERT(child == sc->sc_subdev);
    342 	sc->sc_subdev = NULL;
    343 }
    344 
    345 static int
    346 uftdi_detach(device_t self, int flags)
    347 {
    348 	struct uftdi_softc *sc = device_private(self);
    349 	int rv = 0;
    350 
    351 	DPRINTF(("uftdi_detach: sc=%p flags=%d\n", sc, flags));
    352 
    353 	sc->sc_dying = true;
    354 
    355 	if (sc->sc_subdev != NULL) {
    356 		rv = config_detach(sc->sc_subdev, flags);
    357 		sc->sc_subdev = NULL;
    358 	}
    359 
    360 	usbd_add_drv_event(USB_EVENT_DRIVER_DETACH, sc->sc_udev, sc->sc_dev);
    361 
    362 	return rv;
    363 }
    364 
    365 static int
    366 uftdi_open(void *vsc, int portno)
    367 {
    368 	struct uftdi_softc *sc = vsc;
    369 	usb_device_request_t req;
    370 	usbd_status err;
    371 	struct termios t;
    372 
    373 	DPRINTF(("uftdi_open: sc=%p\n", sc));
    374 
    375 	if (sc->sc_dying)
    376 		return EIO;
    377 
    378 	/* Perform a full reset on the device */
    379 	req.bmRequestType = UT_WRITE_VENDOR_DEVICE;
    380 	req.bRequest = FTDI_SIO_RESET;
    381 	USETW(req.wValue, FTDI_SIO_RESET_SIO);
    382 	USETW(req.wIndex, portno);
    383 	USETW(req.wLength, 0);
    384 	err = usbd_do_request(sc->sc_udev, &req, NULL);
    385 	if (err)
    386 		return EIO;
    387 
    388 	/* Set 9600 baud, 2 stop bits, no parity, 8 bits */
    389 	t.c_ospeed = 9600;
    390 	t.c_cflag = CSTOPB | CS8;
    391 	(void)uftdi_param(sc, portno, &t);
    392 
    393 	/* Turn on RTS/CTS flow control */
    394 	req.bmRequestType = UT_WRITE_VENDOR_DEVICE;
    395 	req.bRequest = FTDI_SIO_SET_FLOW_CTRL;
    396 	USETW(req.wValue, 0);
    397 	USETW2(req.wIndex, FTDI_SIO_RTS_CTS_HS, portno);
    398 	USETW(req.wLength, 0);
    399 	err = usbd_do_request(sc->sc_udev, &req, NULL);
    400 	if (err)
    401 		return EIO;
    402 
    403 	return 0;
    404 }
    405 
    406 static void
    407 uftdi_read(void *vsc, int portno, u_char **ptr, uint32_t *count)
    408 {
    409 	struct uftdi_softc *sc = vsc;
    410 	u_char msr, lsr;
    411 
    412 	DPRINTFN(15,("uftdi_read: sc=%p, port=%d count=%d\n", sc, portno,
    413 		     *count));
    414 
    415 	msr = FTDI_GET_MSR(*ptr);
    416 	lsr = FTDI_GET_LSR(*ptr);
    417 
    418 #ifdef UFTDI_DEBUG
    419 	if (*count != 2)
    420 		DPRINTFN(10,("uftdi_read: sc=%p, port=%d count=%d data[0]="
    421 			    "0x%02x\n", sc, portno, *count, (*ptr)[2]));
    422 #endif
    423 
    424 	if (sc->sc_msr != msr ||
    425 	    (sc->sc_lsr & FTDI_LSR_MASK) != (lsr & FTDI_LSR_MASK)) {
    426 		DPRINTF(("uftdi_read: status change msr=0x%02x(0x%02x) "
    427 			 "lsr=0x%02x(0x%02x)\n", msr, sc->sc_msr,
    428 			 lsr, sc->sc_lsr));
    429 		sc->sc_msr = msr;
    430 		sc->sc_lsr = lsr;
    431 		ucom_status_change(device_private(sc->sc_subdev));
    432 	}
    433 
    434 	/* Adjust buffer pointer to skip status prefix */
    435 	*ptr += 2;
    436 }
    437 
    438 static void
    439 uftdi_write(void *vsc, int portno, u_char *to, u_char *from, uint32_t *count)
    440 {
    441 	struct uftdi_softc *sc = vsc;
    442 
    443 	DPRINTFN(10,("uftdi_write: sc=%p, port=%d count=%u data[0]=0x%02x\n",
    444 		     vsc, portno, *count, from[0]));
    445 
    446 	/* Make length tag and copy data */
    447 	if (sc->sc_hdrlen > 0)
    448 		*to = FTDI_OUT_TAG(*count, portno);
    449 
    450 	memcpy(to + sc->sc_hdrlen, from, *count);
    451 	*count += sc->sc_hdrlen;
    452 }
    453 
    454 static void
    455 uftdi_set(void *vsc, int portno, int reg, int onoff)
    456 {
    457 	struct uftdi_softc *sc = vsc;
    458 	usb_device_request_t req;
    459 	int ctl;
    460 
    461 	DPRINTF(("uftdi_set: sc=%p, port=%d reg=%d onoff=%d\n", vsc, portno,
    462 		 reg, onoff));
    463 
    464 	if (sc->sc_dying)
    465 		return;
    466 
    467 	switch (reg) {
    468 	case UCOM_SET_DTR:
    469 		ctl = onoff ? FTDI_SIO_SET_DTR_HIGH : FTDI_SIO_SET_DTR_LOW;
    470 		break;
    471 	case UCOM_SET_RTS:
    472 		ctl = onoff ? FTDI_SIO_SET_RTS_HIGH : FTDI_SIO_SET_RTS_LOW;
    473 		break;
    474 	case UCOM_SET_BREAK:
    475 		uftdi_break(sc, portno, onoff);
    476 		return;
    477 	default:
    478 		return;
    479 	}
    480 	req.bmRequestType = UT_WRITE_VENDOR_DEVICE;
    481 	req.bRequest = FTDI_SIO_MODEM_CTRL;
    482 	USETW(req.wValue, ctl);
    483 	USETW(req.wIndex, portno);
    484 	USETW(req.wLength, 0);
    485 	DPRINTFN(2,("uftdi_set: reqtype=0x%02x req=0x%02x value=0x%04x "
    486 		    "index=0x%04x len=%d\n", req.bmRequestType, req.bRequest,
    487 		    UGETW(req.wValue), UGETW(req.wIndex), UGETW(req.wLength)));
    488 	(void)usbd_do_request(sc->sc_udev, &req, NULL);
    489 }
    490 
    491 static int
    492 uftdi_param(void *vsc, int portno, struct termios *t)
    493 {
    494 	struct uftdi_softc *sc = vsc;
    495 	usb_device_request_t req;
    496 	usbd_status err;
    497 	int rate, data, flow;
    498 
    499 	DPRINTF(("uftdi_param: sc=%p\n", sc));
    500 
    501 	if (sc->sc_dying)
    502 		return EIO;
    503 
    504 	req.bmRequestType = UT_WRITE_VENDOR_DEVICE;
    505 	req.bRequest = FTDI_SIO_SET_BITMODE;
    506 	USETW(req.wValue, FTDI_BITMODE_RESET << 8 | 0x00);
    507 	USETW(req.wIndex, portno);
    508 	USETW(req.wLength, 0);
    509 	err = usbd_do_request(sc->sc_udev, &req, NULL);
    510 	if (err)
    511 		return EIO;
    512 
    513 	switch (sc->sc_type) {
    514 	case UFTDI_TYPE_SIO:
    515 		switch (t->c_ospeed) {
    516 		case 300: rate = ftdi_sio_b300; break;
    517 		case 600: rate = ftdi_sio_b600; break;
    518 		case 1200: rate = ftdi_sio_b1200; break;
    519 		case 2400: rate = ftdi_sio_b2400; break;
    520 		case 4800: rate = ftdi_sio_b4800; break;
    521 		case 9600: rate = ftdi_sio_b9600; break;
    522 		case 19200: rate = ftdi_sio_b19200; break;
    523 		case 38400: rate = ftdi_sio_b38400; break;
    524 		case 57600: rate = ftdi_sio_b57600; break;
    525 		case 115200: rate = ftdi_sio_b115200; break;
    526 		default:
    527 			return EINVAL;
    528 		}
    529 		break;
    530 
    531 	case UFTDI_TYPE_8U232AM:
    532 		switch(t->c_ospeed) {
    533 		case 300: rate = ftdi_8u232am_b300; break;
    534 		case 600: rate = ftdi_8u232am_b600; break;
    535 		case 1200: rate = ftdi_8u232am_b1200; break;
    536 		case 2400: rate = ftdi_8u232am_b2400; break;
    537 		case 4800: rate = ftdi_8u232am_b4800; break;
    538 		case 9600: rate = ftdi_8u232am_b9600; break;
    539 		case 19200: rate = ftdi_8u232am_b19200; break;
    540 		case 38400: rate = ftdi_8u232am_b38400; break;
    541 		case 57600: rate = ftdi_8u232am_b57600; break;
    542 		case 115200: rate = ftdi_8u232am_b115200; break;
    543 		case 230400: rate = ftdi_8u232am_b230400; break;
    544 		case 460800: rate = ftdi_8u232am_b460800; break;
    545 		case 921600: rate = ftdi_8u232am_b921600; break;
    546 		default:
    547 			return EINVAL;
    548 		}
    549 		break;
    550 
    551 	default:
    552 		return EINVAL;
    553 	}
    554 	req.bmRequestType = UT_WRITE_VENDOR_DEVICE;
    555 	req.bRequest = FTDI_SIO_SET_BAUD_RATE;
    556 	USETW(req.wValue, rate);
    557 	USETW(req.wIndex, portno);
    558 	USETW(req.wLength, 0);
    559 	DPRINTFN(2,("uftdi_param: reqtype=0x%02x req=0x%02x value=0x%04x "
    560 		    "index=0x%04x len=%d\n", req.bmRequestType, req.bRequest,
    561 		    UGETW(req.wValue), UGETW(req.wIndex), UGETW(req.wLength)));
    562 	err = usbd_do_request(sc->sc_udev, &req, NULL);
    563 	if (err)
    564 		return EIO;
    565 
    566 	if (ISSET(t->c_cflag, CSTOPB))
    567 		data = FTDI_SIO_SET_DATA_STOP_BITS_2;
    568 	else
    569 		data = FTDI_SIO_SET_DATA_STOP_BITS_1;
    570 	if (ISSET(t->c_cflag, PARENB)) {
    571 		if (ISSET(t->c_cflag, PARODD))
    572 			data |= FTDI_SIO_SET_DATA_PARITY_ODD;
    573 		else
    574 			data |= FTDI_SIO_SET_DATA_PARITY_EVEN;
    575 	} else
    576 		data |= FTDI_SIO_SET_DATA_PARITY_NONE;
    577 	switch (ISSET(t->c_cflag, CSIZE)) {
    578 	case CS5:
    579 		data |= FTDI_SIO_SET_DATA_BITS(5);
    580 		break;
    581 	case CS6:
    582 		data |= FTDI_SIO_SET_DATA_BITS(6);
    583 		break;
    584 	case CS7:
    585 		data |= FTDI_SIO_SET_DATA_BITS(7);
    586 		break;
    587 	case CS8:
    588 		data |= FTDI_SIO_SET_DATA_BITS(8);
    589 		break;
    590 	}
    591 	sc->last_lcr = data;
    592 
    593 	req.bmRequestType = UT_WRITE_VENDOR_DEVICE;
    594 	req.bRequest = FTDI_SIO_SET_DATA;
    595 	USETW(req.wValue, data);
    596 	USETW(req.wIndex, portno);
    597 	USETW(req.wLength, 0);
    598 	DPRINTFN(2,("uftdi_param: reqtype=0x%02x req=0x%02x value=0x%04x "
    599 		    "index=0x%04x len=%d\n", req.bmRequestType, req.bRequest,
    600 		    UGETW(req.wValue), UGETW(req.wIndex), UGETW(req.wLength)));
    601 	err = usbd_do_request(sc->sc_udev, &req, NULL);
    602 	if (err)
    603 		return EIO;
    604 
    605 	if (ISSET(t->c_cflag, CRTSCTS)) {
    606 		flow = FTDI_SIO_RTS_CTS_HS;
    607 		USETW(req.wValue, 0);
    608 	} else if (ISSET(t->c_iflag, IXON) && ISSET(t->c_iflag, IXOFF)) {
    609 		flow = FTDI_SIO_XON_XOFF_HS;
    610 		USETW2(req.wValue, t->c_cc[VSTOP], t->c_cc[VSTART]);
    611 	} else {
    612 		flow = FTDI_SIO_DISABLE_FLOW_CTRL;
    613 		USETW(req.wValue, 0);
    614 	}
    615 	req.bmRequestType = UT_WRITE_VENDOR_DEVICE;
    616 	req.bRequest = FTDI_SIO_SET_FLOW_CTRL;
    617 	USETW2(req.wIndex, flow, portno);
    618 	USETW(req.wLength, 0);
    619 	err = usbd_do_request(sc->sc_udev, &req, NULL);
    620 	if (err)
    621 		return EIO;
    622 
    623 	return 0;
    624 }
    625 
    626 static void
    627 uftdi_get_status(void *vsc, int portno, u_char *lsr, u_char *msr)
    628 {
    629 	struct uftdi_softc *sc = vsc;
    630 
    631 	DPRINTF(("uftdi_status: msr=0x%02x lsr=0x%02x\n",
    632 		 sc->sc_msr, sc->sc_lsr));
    633 
    634 	if (sc->sc_dying)
    635 		return;
    636 
    637 	*msr = sc->sc_msr;
    638 	*lsr = sc->sc_lsr;
    639 }
    640 
    641 static void
    642 uftdi_break(void *vsc, int portno, int onoff)
    643 {
    644 	struct uftdi_softc *sc = vsc;
    645 	usb_device_request_t req;
    646 	int data;
    647 
    648 	DPRINTF(("uftdi_break: sc=%p, port=%d onoff=%d\n", vsc, portno,
    649 		  onoff));
    650 
    651 	if (onoff) {
    652 		data = sc->last_lcr | FTDI_SIO_SET_BREAK;
    653 	} else {
    654 		data = sc->last_lcr;
    655 	}
    656 
    657 	req.bmRequestType = UT_WRITE_VENDOR_DEVICE;
    658 	req.bRequest = FTDI_SIO_SET_DATA;
    659 	USETW(req.wValue, data);
    660 	USETW(req.wIndex, portno);
    661 	USETW(req.wLength, 0);
    662 	(void)usbd_do_request(sc->sc_udev, &req, NULL);
    663 }
    664