root/sys/bus/u4b/serial/uftdi.c
/*      $NetBSD: uftdi.c,v 1.13 2002/09/23 05:51:23 simonb Exp $        */

/*-
 * Copyright (c) 2000 The NetBSD Foundation, Inc.
 * All rights reserved.
 *
 * This code is derived from software contributed to The NetBSD Foundation
 * by Lennart Augustsson (lennart@augustsson.net).
 *
 * Redistribution and use in source and binary forms, with or without
 * modification, are permitted provided that the following conditions
 * are met:
 * 1. Redistributions of source code must retain the above copyright
 *    notice, this list of conditions and the following disclaimer.
 * 2. Redistributions in binary form must reproduce the above copyright
 *    notice, this list of conditions and the following disclaimer in the
 *    documentation and/or other materials provided with the distribution.
 *
 * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
 * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
 * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
 * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
 * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
 * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
 * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
 * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
 * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
 * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
 * POSSIBILITY OF SUCH DAMAGE.
 */

/*
 * NOTE: all function names beginning like "uftdi_cfg_" can only
 * be called from within the config thread function !
 */

/*
 * FTDI FT8U100AX serial adapter driver
 */

#include <sys/stdint.h>
#include <sys/param.h>
#include <sys/queue.h>
#include <sys/types.h>
#include <sys/systm.h>
#include <sys/kernel.h>
#include <sys/bus.h>
#include <sys/module.h>
#include <sys/lock.h>
#include <sys/condvar.h>
#include <sys/sysctl.h>
#include <sys/unistd.h>
#include <sys/callout.h>
#include <sys/malloc.h>
#include <sys/caps.h>
#include <sys/serial.h>

#include <bus/u4b/usb.h>
#include <bus/u4b/usbdi.h>
#include <bus/u4b/usbdi_util.h>
#include "usbdevs.h"

#define USB_DEBUG_VAR uftdi_debug
#include <bus/u4b/usb_debug.h>
#include <bus/u4b/usb_process.h>

#include <bus/u4b/serial/usb_serial.h>
#include <bus/u4b/serial/uftdi_reg.h>

#ifdef USB_DEBUG
static int uftdi_debug = 0;

static SYSCTL_NODE(_hw_usb, OID_AUTO, uftdi, CTLFLAG_RW, 0, "USB uftdi");
SYSCTL_INT(_hw_usb_uftdi, OID_AUTO, debug, CTLFLAG_RW,
    &uftdi_debug, 0, "Debug level");
TUNABLE_INT("hw.usb.uftdi.debug", &uftdi_debug);
#endif

#define UFTDI_CONFIG_INDEX      0
#define UFTDI_IFACE_INDEX       0

#define UFTDI_OBUFSIZE 64               /* bytes, cannot be increased due to
                                         * do size encoding */

enum {
        UFTDI_BULK_DT_WR,
        UFTDI_BULK_DT_RD,
        UFTDI_N_TRANSFER,
};

struct uftdi_softc {
        struct ucom_super_softc sc_super_ucom;
        struct ucom_softc sc_ucom;

        struct usb_device *sc_udev;
        struct usb_xfer *sc_xfer[UFTDI_N_TRANSFER];
        device_t sc_dev;
        struct lock sc_lock;

        uint32_t sc_unit;
        enum uftdi_type sc_type;

        uint16_t sc_last_lcr;

        uint8_t sc_iface_index;
        uint8_t sc_hdrlen;
        uint8_t sc_msr;
        uint8_t sc_lsr;

        uint8_t sc_name[16];
};

struct uftdi_param_config {
        uint16_t rate;
        uint16_t lcr;
        uint8_t v_start;
        uint8_t v_stop;
        uint8_t v_flow;
};

/* prototypes */

static device_probe_t uftdi_probe;
static device_attach_t uftdi_attach;
static device_detach_t uftdi_detach;

static usb_callback_t uftdi_write_callback;
static usb_callback_t uftdi_read_callback;

static void     uftdi_cfg_open(struct ucom_softc *);
static void     uftdi_cfg_set_dtr(struct ucom_softc *, uint8_t);
static void     uftdi_cfg_set_rts(struct ucom_softc *, uint8_t);
static void     uftdi_cfg_set_break(struct ucom_softc *, uint8_t);
static int      uftdi_set_parm_soft(struct termios *,
                    struct uftdi_param_config *, uint8_t);
static int      uftdi_pre_param(struct ucom_softc *, struct termios *);
static void     uftdi_cfg_param(struct ucom_softc *, struct termios *);
static void     uftdi_cfg_get_status(struct ucom_softc *, uint8_t *,
                    uint8_t *);
static void     uftdi_start_read(struct ucom_softc *);
static void     uftdi_stop_read(struct ucom_softc *);
static void     uftdi_start_write(struct ucom_softc *);
static void     uftdi_stop_write(struct ucom_softc *);
static uint8_t  uftdi_8u232am_getrate(uint32_t, uint16_t *);
static void     uftdi_poll(struct ucom_softc *ucom);

static const struct usb_config uftdi_config[UFTDI_N_TRANSFER] = {

        [UFTDI_BULK_DT_WR] = {
                .type = UE_BULK,
                .endpoint = UE_ADDR_ANY,
                .direction = UE_DIR_OUT,
                .bufsize = UFTDI_OBUFSIZE,
                .flags = {.pipe_bof = 1,},
                .callback = &uftdi_write_callback,
        },

        [UFTDI_BULK_DT_RD] = {
                .type = UE_BULK,
                .endpoint = UE_ADDR_ANY,
                .direction = UE_DIR_IN,
                .bufsize = 0,           /* use wMaxPacketSize */
                .flags = {.pipe_bof = 1,.short_xfer_ok = 1,},
                .callback = &uftdi_read_callback,
        },
};

static const struct ucom_callback uftdi_callback = {
        .ucom_cfg_get_status = &uftdi_cfg_get_status,
        .ucom_cfg_set_dtr = &uftdi_cfg_set_dtr,
        .ucom_cfg_set_rts = &uftdi_cfg_set_rts,
        .ucom_cfg_set_break = &uftdi_cfg_set_break,
        .ucom_cfg_param = &uftdi_cfg_param,
        .ucom_cfg_open = &uftdi_cfg_open,
        .ucom_pre_param = &uftdi_pre_param,
        .ucom_start_read = &uftdi_start_read,
        .ucom_stop_read = &uftdi_stop_read,
        .ucom_start_write = &uftdi_start_write,
        .ucom_stop_write = &uftdi_stop_write,
        .ucom_poll = &uftdi_poll,
};

static device_method_t uftdi_methods[] = {
        /* Device interface */
        DEVMETHOD(device_probe, uftdi_probe),
        DEVMETHOD(device_attach, uftdi_attach),
        DEVMETHOD(device_detach, uftdi_detach),

        DEVMETHOD_END
};

static devclass_t uftdi_devclass;

static driver_t uftdi_driver = {
        .name = "uftdi",
        .methods = uftdi_methods,
        .size = sizeof(struct uftdi_softc),
};

DRIVER_MODULE(uftdi, uhub, uftdi_driver, uftdi_devclass, NULL, NULL);
MODULE_DEPEND(uftdi, ucom, 1, 1, 1);
MODULE_DEPEND(uftdi, usb, 1, 1, 1);
MODULE_VERSION(uftdi, 1);

static const STRUCT_USB_HOST_ID uftdi_devs[] = {
#define UFTDI_DEV(v,p,t) \
  { USB_VPI(USB_VENDOR_##v, USB_PRODUCT_##v##_##p, UFTDI_TYPE_##t) }
        UFTDI_DEV(ATMEL, STK541, 8U232AM),
        UFTDI_DEV(DRESDENELEKTRONIK, SENSORTERMINALBOARD, 8U232AM),
        UFTDI_DEV(DRESDENELEKTRONIK, WIRELESSHANDHELDTERMINAL, 8U232AM),
        UFTDI_DEV(FALCOM, TWIST, 8U232AM),
        UFTDI_DEV(FTDI, GAMMASCOUT, 8U232AM),
        UFTDI_DEV(FTDI, SERIAL_8U100AX, SIO),
        UFTDI_DEV(FTDI, SERIAL_2232C, 8U232AM),
        UFTDI_DEV(FTDI, SERIAL_2232D, 8U232AM),
        UFTDI_DEV(FTDI, SERIAL_4232H, 8U232AM),
        UFTDI_DEV(FTDI, SERIAL_8U232AM, 8U232AM),
        UFTDI_DEV(FTDI, SERIAL_8U232AM4, 8U232AM),
        UFTDI_DEV(FTDI, SEMC_DSS20, 8U232AM),
        UFTDI_DEV(FTDI, CFA_631, 8U232AM),
        UFTDI_DEV(FTDI, CFA_632, 8U232AM),
        UFTDI_DEV(FTDI, CFA_633, 8U232AM),
        UFTDI_DEV(FTDI, CFA_634, 8U232AM),
        UFTDI_DEV(FTDI, CFA_635, 8U232AM),
        UFTDI_DEV(FTDI, USB_UIRT, 8U232AM),
        UFTDI_DEV(FTDI, USBSERIAL, 8U232AM),
        UFTDI_DEV(FTDI, XDS100V2, 8U232AM),
        UFTDI_DEV(FTDI, KBS, 8U232AM),
        UFTDI_DEV(FTDI, MX2_3, 8U232AM),
        UFTDI_DEV(FTDI, MX4_5, 8U232AM),
        UFTDI_DEV(FTDI, LK202, 8U232AM),
        UFTDI_DEV(FTDI, LK204, 8U232AM),
        UFTDI_DEV(FTDI, TACTRIX_OPENPORT_13M, 8U232AM),
        UFTDI_DEV(FTDI, TACTRIX_OPENPORT_13S, 8U232AM),
        UFTDI_DEV(FTDI, TACTRIX_OPENPORT_13U, 8U232AM),
        UFTDI_DEV(FTDI, EISCOU, 8U232AM),
        UFTDI_DEV(FTDI, UOPTBR, 8U232AM),
        UFTDI_DEV(FTDI, EMCU2D, 8U232AM),
        UFTDI_DEV(FTDI, PCMSFU, 8U232AM),
        UFTDI_DEV(FTDI, EMCU2H, 8U232AM),
        UFTDI_DEV(FTDI, MAXSTREAM, 8U232AM),
        UFTDI_DEV(FTDI, CTI_USB_NANO_485, 8U232AM),
        UFTDI_DEV(FTDI, CTI_USB_MINI_485, 8U232AM),
        UFTDI_DEV(SIIG2, US2308, 8U232AM),
        UFTDI_DEV(INTREPIDCS, VALUECAN, 8U232AM),
        UFTDI_DEV(INTREPIDCS, NEOVI, 8U232AM),
        UFTDI_DEV(BBELECTRONICS, USOTL4, 8U232AM),
        UFTDI_DEV(MATRIXORBITAL, MOUA, 8U232AM),
        UFTDI_DEV(MARVELL, SHEEVAPLUG, 8U232AM),
        UFTDI_DEV(MELCO, PCOPRS1, 8U232AM),
        UFTDI_DEV(RATOC, REXUSB60F, 8U232AM),
#undef UFTDI_DEV
};

static int
uftdi_probe(device_t dev)
{
        struct usb_attach_arg *uaa = device_get_ivars(dev);

        if (uaa->usb_mode != USB_MODE_HOST) {
                return (ENXIO);
        }
        if (uaa->info.bConfigIndex != UFTDI_CONFIG_INDEX) {
                return (ENXIO);
        }
        /* attach to all present interfaces */

        return (usbd_lookup_id_by_uaa(uftdi_devs, sizeof(uftdi_devs), uaa));
}

static int
uftdi_attach(device_t dev)
{
        struct usb_attach_arg *uaa = device_get_ivars(dev);
        struct uftdi_softc *sc = device_get_softc(dev);
        int error;

        sc->sc_udev = uaa->device;
        sc->sc_dev = dev;
        sc->sc_unit = device_get_unit(dev);

        device_set_usb_desc(dev);
        lockinit(&sc->sc_lock, "uftdi", 0, LK_CANRECURSE);

        ksnprintf(sc->sc_name, sizeof(sc->sc_name),
            "%s", device_get_nameunit(dev));

        DPRINTF("\n");

        sc->sc_iface_index = uaa->info.bIfaceIndex;
        sc->sc_type = USB_GET_DRIVER_INFO(uaa);

        switch (sc->sc_type) {
        case UFTDI_TYPE_SIO:
                sc->sc_hdrlen = 1;
                break;
        case UFTDI_TYPE_8U232AM:
        default:
                sc->sc_hdrlen = 0;
                break;
        }

        error = usbd_transfer_setup(uaa->device,
            &sc->sc_iface_index, sc->sc_xfer, uftdi_config,
            UFTDI_N_TRANSFER, sc, &sc->sc_lock);

        if (error) {
                device_printf(dev, "allocating USB "
                    "transfers failed\n");
                goto detach;
        }
        sc->sc_ucom.sc_portno = FTDI_PIT_SIOA + uaa->info.bIfaceNum;

        /* clear stall at first run */
        lockmgr(&sc->sc_lock, LK_EXCLUSIVE);
        usbd_xfer_set_stall(sc->sc_xfer[UFTDI_BULK_DT_WR]);
        usbd_xfer_set_stall(sc->sc_xfer[UFTDI_BULK_DT_RD]);
        lockmgr(&sc->sc_lock, LK_RELEASE);

        /* set a valid "lcr" value */

        sc->sc_last_lcr =
            (FTDI_SIO_SET_DATA_STOP_BITS_2 |
            FTDI_SIO_SET_DATA_PARITY_NONE |
            FTDI_SIO_SET_DATA_BITS(8));

        error = ucom_attach(&sc->sc_super_ucom, &sc->sc_ucom, 1, sc,
            &uftdi_callback, &sc->sc_lock);
        if (error) {
                goto detach;
        }
        ucom_set_pnpinfo_usb(&sc->sc_super_ucom, dev);

        return (0);                     /* success */

detach:
        uftdi_detach(dev);
        return (ENXIO);
}

static int
uftdi_detach(device_t dev)
{
        struct uftdi_softc *sc = device_get_softc(dev);

        ucom_detach(&sc->sc_super_ucom, &sc->sc_ucom);
        usbd_transfer_unsetup(sc->sc_xfer, UFTDI_N_TRANSFER);
        lockuninit(&sc->sc_lock);

        return (0);
}

static void
uftdi_cfg_open(struct ucom_softc *ucom)
{
        struct uftdi_softc *sc = ucom->sc_parent;
        uint16_t wIndex = ucom->sc_portno;
        struct usb_device_request req;

        DPRINTF("");

        /* perform a full reset on the device */

        req.bmRequestType = UT_WRITE_VENDOR_DEVICE;
        req.bRequest = FTDI_SIO_RESET;
        USETW(req.wValue, FTDI_SIO_RESET_SIO);
        USETW(req.wIndex, wIndex);
        USETW(req.wLength, 0);
        ucom_cfg_do_request(sc->sc_udev, &sc->sc_ucom,
            &req, NULL, 0, 1000);

        /* turn on RTS/CTS flow control */

        req.bmRequestType = UT_WRITE_VENDOR_DEVICE;
        req.bRequest = FTDI_SIO_SET_FLOW_CTRL;
        USETW(req.wValue, 0);
        USETW2(req.wIndex, FTDI_SIO_RTS_CTS_HS, wIndex);
        USETW(req.wLength, 0);
        ucom_cfg_do_request(sc->sc_udev, &sc->sc_ucom,
            &req, NULL, 0, 1000);

        /*
         * NOTE: with the new UCOM layer there will always be a
         * "uftdi_cfg_param()" call after "open()", so there is no need for
         * "open()" to configure anything
         */
}

static void
uftdi_write_callback(struct usb_xfer *xfer, usb_error_t error)
{
        struct uftdi_softc *sc = usbd_xfer_softc(xfer);
        struct usb_page_cache *pc;
        uint32_t actlen;
        uint8_t buf[1];

        switch (USB_GET_STATE(xfer)) {
        case USB_ST_SETUP:
        case USB_ST_TRANSFERRED:
tr_setup:
                pc = usbd_xfer_get_frame(xfer, 0);
                if (ucom_get_data(&sc->sc_ucom, pc,
                    sc->sc_hdrlen, UFTDI_OBUFSIZE - sc->sc_hdrlen,
                    &actlen)) {

                        if (sc->sc_hdrlen > 0) {
                                buf[0] =
                                    FTDI_OUT_TAG(actlen, sc->sc_ucom.sc_portno);
                                usbd_copy_in(pc, 0, buf, 1);
                        }
                        usbd_xfer_set_frame_len(xfer, 0, actlen + sc->sc_hdrlen);
                        usbd_transfer_submit(xfer);
                }
                return;

        default:                        /* Error */
                if (error != USB_ERR_CANCELLED) {
                        /* try to clear stall first */
                        usbd_xfer_set_stall(xfer);
                        goto tr_setup;
                }
                return;
        }
}

static void
uftdi_read_callback(struct usb_xfer *xfer, usb_error_t error)
{
        struct uftdi_softc *sc = usbd_xfer_softc(xfer);
        struct usb_page_cache *pc;
        uint8_t buf[2];
        uint8_t ftdi_msr;
        uint8_t msr;
        uint8_t lsr;
        int actlen;

        usbd_xfer_status(xfer, &actlen, NULL, NULL, NULL);

        switch (USB_GET_STATE(xfer)) {
        case USB_ST_TRANSFERRED:

                if (actlen < 2) {
                        goto tr_setup;
                }
                pc = usbd_xfer_get_frame(xfer, 0);
                usbd_copy_out(pc, 0, buf, 2);

                ftdi_msr = FTDI_GET_MSR(buf);
                lsr = FTDI_GET_LSR(buf);

                msr = 0;
                if (ftdi_msr & FTDI_SIO_CTS_MASK)
                        msr |= SER_CTS;
                if (ftdi_msr & FTDI_SIO_DSR_MASK)
                        msr |= SER_DSR;
                if (ftdi_msr & FTDI_SIO_RI_MASK)
                        msr |= SER_RI;
                if (ftdi_msr & FTDI_SIO_RLSD_MASK)
                        msr |= SER_DCD;

                if ((sc->sc_msr != msr) ||
                    ((sc->sc_lsr & FTDI_LSR_MASK) != (lsr & FTDI_LSR_MASK))) {
                        DPRINTF("status change msr=0x%02x (0x%02x) "
                            "lsr=0x%02x (0x%02x)\n", msr, sc->sc_msr,
                            lsr, sc->sc_lsr);

                        sc->sc_msr = msr;
                        sc->sc_lsr = lsr;

                        ucom_status_change(&sc->sc_ucom);
                }
                actlen -= 2;

                if (actlen > 0) {
                        ucom_put_data(&sc->sc_ucom, pc, 2, actlen);
                }
        case USB_ST_SETUP:
tr_setup:
                usbd_xfer_set_frame_len(xfer, 0, usbd_xfer_max_len(xfer));
                usbd_transfer_submit(xfer);
                return;

        default:                        /* Error */
                if (error != USB_ERR_CANCELLED) {
                        /* try to clear stall first */
                        usbd_xfer_set_stall(xfer);
                        goto tr_setup;
                }
                return;
        }
}

static void
uftdi_cfg_set_dtr(struct ucom_softc *ucom, uint8_t onoff)
{
        struct uftdi_softc *sc = ucom->sc_parent;
        uint16_t wIndex = ucom->sc_portno;
        uint16_t wValue;
        struct usb_device_request req;

        wValue = onoff ? FTDI_SIO_SET_DTR_HIGH : FTDI_SIO_SET_DTR_LOW;

        req.bmRequestType = UT_WRITE_VENDOR_DEVICE;
        req.bRequest = FTDI_SIO_MODEM_CTRL;
        USETW(req.wValue, wValue);
        USETW(req.wIndex, wIndex);
        USETW(req.wLength, 0);
        ucom_cfg_do_request(sc->sc_udev, &sc->sc_ucom,
            &req, NULL, 0, 1000);
}

static void
uftdi_cfg_set_rts(struct ucom_softc *ucom, uint8_t onoff)
{
        struct uftdi_softc *sc = ucom->sc_parent;
        uint16_t wIndex = ucom->sc_portno;
        uint16_t wValue;
        struct usb_device_request req;

        wValue = onoff ? FTDI_SIO_SET_RTS_HIGH : FTDI_SIO_SET_RTS_LOW;

        req.bmRequestType = UT_WRITE_VENDOR_DEVICE;
        req.bRequest = FTDI_SIO_MODEM_CTRL;
        USETW(req.wValue, wValue);
        USETW(req.wIndex, wIndex);
        USETW(req.wLength, 0);
        ucom_cfg_do_request(sc->sc_udev, &sc->sc_ucom,
            &req, NULL, 0, 1000);
}

static void
uftdi_cfg_set_break(struct ucom_softc *ucom, uint8_t onoff)
{
        struct uftdi_softc *sc = ucom->sc_parent;
        uint16_t wIndex = ucom->sc_portno;
        uint16_t wValue;
        struct usb_device_request req;

        if (onoff) {
                sc->sc_last_lcr |= FTDI_SIO_SET_BREAK;
        } else {
                sc->sc_last_lcr &= ~FTDI_SIO_SET_BREAK;
        }

        wValue = sc->sc_last_lcr;

        req.bmRequestType = UT_WRITE_VENDOR_DEVICE;
        req.bRequest = FTDI_SIO_SET_DATA;
        USETW(req.wValue, wValue);
        USETW(req.wIndex, wIndex);
        USETW(req.wLength, 0);
        ucom_cfg_do_request(sc->sc_udev, &sc->sc_ucom,
            &req, NULL, 0, 1000);
}

static int
uftdi_set_parm_soft(struct termios *t,
    struct uftdi_param_config *cfg, uint8_t type)
{
        memset(cfg, 0, sizeof(*cfg));

        switch (type) {
        case UFTDI_TYPE_SIO:
                switch (t->c_ospeed) {
                case 300:
                        cfg->rate = ftdi_sio_b300;
                        break;
                case 600:
                        cfg->rate = ftdi_sio_b600;
                        break;
                case 1200:
                        cfg->rate = ftdi_sio_b1200;
                        break;
                case 2400:
                        cfg->rate = ftdi_sio_b2400;
                        break;
                case 4800:
                        cfg->rate = ftdi_sio_b4800;
                        break;
                case 9600:
                        cfg->rate = ftdi_sio_b9600;
                        break;
                case 19200:
                        cfg->rate = ftdi_sio_b19200;
                        break;
                case 38400:
                        cfg->rate = ftdi_sio_b38400;
                        break;
                case 57600:
                        cfg->rate = ftdi_sio_b57600;
                        break;
                case 115200:
                        cfg->rate = ftdi_sio_b115200;
                        break;
                default:
                        return (EINVAL);
                }
                break;

        case UFTDI_TYPE_8U232AM:
                if (uftdi_8u232am_getrate(t->c_ospeed, &cfg->rate)) {
                        return (EINVAL);
                }
                break;
        }

        if (t->c_cflag & CSTOPB)
                cfg->lcr = FTDI_SIO_SET_DATA_STOP_BITS_2;
        else
                cfg->lcr = FTDI_SIO_SET_DATA_STOP_BITS_1;

        if (t->c_cflag & PARENB) {
                if (t->c_cflag & PARODD) {
                        cfg->lcr |= FTDI_SIO_SET_DATA_PARITY_ODD;
                } else {
                        cfg->lcr |= FTDI_SIO_SET_DATA_PARITY_EVEN;
                }
        } else {
                cfg->lcr |= FTDI_SIO_SET_DATA_PARITY_NONE;
        }

        switch (t->c_cflag & CSIZE) {
        case CS5:
                cfg->lcr |= FTDI_SIO_SET_DATA_BITS(5);
                break;

        case CS6:
                cfg->lcr |= FTDI_SIO_SET_DATA_BITS(6);
                break;

        case CS7:
                cfg->lcr |= FTDI_SIO_SET_DATA_BITS(7);
                break;

        case CS8:
                cfg->lcr |= FTDI_SIO_SET_DATA_BITS(8);
                break;
        }

        if (t->c_cflag & CRTSCTS) {
                cfg->v_flow = FTDI_SIO_RTS_CTS_HS;
        } else if (t->c_iflag & (IXON | IXOFF)) {
                cfg->v_flow = FTDI_SIO_XON_XOFF_HS;
                cfg->v_start = t->c_cc[VSTART];
                cfg->v_stop = t->c_cc[VSTOP];
        } else {
                cfg->v_flow = FTDI_SIO_DISABLE_FLOW_CTRL;
        }

        return (0);
}

static int
uftdi_pre_param(struct ucom_softc *ucom, struct termios *t)
{
        struct uftdi_softc *sc = ucom->sc_parent;
        struct uftdi_param_config cfg;

        DPRINTF("\n");

        return (uftdi_set_parm_soft(t, &cfg, sc->sc_type));
}

static void
uftdi_cfg_param(struct ucom_softc *ucom, struct termios *t)
{
        struct uftdi_softc *sc = ucom->sc_parent;
        uint16_t wIndex = ucom->sc_portno;
        struct uftdi_param_config cfg;
        struct usb_device_request req;

        if (uftdi_set_parm_soft(t, &cfg, sc->sc_type)) {
                /* should not happen */
                return;
        }
        sc->sc_last_lcr = cfg.lcr;

        DPRINTF("\n");

        req.bmRequestType = UT_WRITE_VENDOR_DEVICE;
        req.bRequest = FTDI_SIO_SET_BAUD_RATE;
        USETW(req.wValue, cfg.rate);
        USETW(req.wIndex, wIndex);
        USETW(req.wLength, 0);
        ucom_cfg_do_request(sc->sc_udev, &sc->sc_ucom,
            &req, NULL, 0, 1000);

        req.bmRequestType = UT_WRITE_VENDOR_DEVICE;
        req.bRequest = FTDI_SIO_SET_DATA;
        USETW(req.wValue, cfg.lcr);
        USETW(req.wIndex, wIndex);
        USETW(req.wLength, 0);
        ucom_cfg_do_request(sc->sc_udev, &sc->sc_ucom,
            &req, NULL, 0, 1000);

        req.bmRequestType = UT_WRITE_VENDOR_DEVICE;
        req.bRequest = FTDI_SIO_SET_FLOW_CTRL;
        USETW2(req.wValue, cfg.v_stop, cfg.v_start);
        USETW2(req.wIndex, cfg.v_flow, wIndex);
        USETW(req.wLength, 0);
        ucom_cfg_do_request(sc->sc_udev, &sc->sc_ucom,
            &req, NULL, 0, 1000);
}

static void
uftdi_cfg_get_status(struct ucom_softc *ucom, uint8_t *lsr, uint8_t *msr)
{
        struct uftdi_softc *sc = ucom->sc_parent;

        DPRINTF("msr=0x%02x lsr=0x%02x\n",
            sc->sc_msr, sc->sc_lsr);

        *msr = sc->sc_msr;
        *lsr = sc->sc_lsr;
}

static void
uftdi_start_read(struct ucom_softc *ucom)
{
        struct uftdi_softc *sc = ucom->sc_parent;

        usbd_transfer_start(sc->sc_xfer[UFTDI_BULK_DT_RD]);
}

static void
uftdi_stop_read(struct ucom_softc *ucom)
{
        struct uftdi_softc *sc = ucom->sc_parent;

        usbd_transfer_stop(sc->sc_xfer[UFTDI_BULK_DT_RD]);
}

static void
uftdi_start_write(struct ucom_softc *ucom)
{
        struct uftdi_softc *sc = ucom->sc_parent;

        usbd_transfer_start(sc->sc_xfer[UFTDI_BULK_DT_WR]);
}

static void
uftdi_stop_write(struct ucom_softc *ucom)
{
        struct uftdi_softc *sc = ucom->sc_parent;

        usbd_transfer_stop(sc->sc_xfer[UFTDI_BULK_DT_WR]);
}

/*------------------------------------------------------------------------*
 *      uftdi_8u232am_getrate
 *
 * Return values:
 *    0: Success
 * Else: Failure
 *------------------------------------------------------------------------*/
static uint8_t
uftdi_8u232am_getrate(uint32_t speed, uint16_t *rate)
{
        /* Table of the nearest even powers-of-2 for values 0..15. */
        static const uint8_t roundoff[16] = {
                0, 2, 2, 4, 4, 4, 8, 8,
                8, 8, 8, 8, 16, 16, 16, 16,
        };
        uint32_t d;
        uint32_t freq;
        uint16_t result;

        if ((speed < 178) || (speed > ((3000000 * 100) / 97)))
                return (1);             /* prevent numerical overflow */

        /* Special cases for 2M and 3M. */
        if ((speed >= ((3000000 * 100) / 103)) &&
            (speed <= ((3000000 * 100) / 97))) {
                result = 0;
                goto done;
        }
        if ((speed >= ((2000000 * 100) / 103)) &&
            (speed <= ((2000000 * 100) / 97))) {
                result = 1;
                goto done;
        }
        d = (FTDI_8U232AM_FREQ << 4) / speed;
        d = (d & ~15) + roundoff[d & 15];

        if (d < FTDI_8U232AM_MIN_DIV)
                d = FTDI_8U232AM_MIN_DIV;
        else if (d > FTDI_8U232AM_MAX_DIV)
                d = FTDI_8U232AM_MAX_DIV;

        /*
         * Calculate the frequency needed for "d" to exactly divide down to
         * our target "speed", and check that the actual frequency is within
         * 3% of this.
         */
        freq = (speed * d);
        if ((freq < ((FTDI_8U232AM_FREQ * 1600ULL) / 103)) ||
            (freq > ((FTDI_8U232AM_FREQ * 1600ULL) / 97)))
                return (1);

        /*
         * Pack the divisor into the resultant value.  The lower 14-bits
         * hold the integral part, while the upper 2 bits encode the
         * fractional component: either 0, 0.5, 0.25, or 0.125.
         */
        result = (d >> 4);
        if (d & 8)
                result |= 0x4000;
        else if (d & 4)
                result |= 0x8000;
        else if (d & 2)
                result |= 0xc000;

done:
        *rate = result;
        return (0);
}

static void
uftdi_poll(struct ucom_softc *ucom)
{
        struct uftdi_softc *sc = ucom->sc_parent;
        usbd_transfer_poll(sc->sc_xfer, UFTDI_N_TRANSFER);
}