The Design and Implementation of the FreeBSD Operating System, Second Edition
Now available: The Design and Implementation of the FreeBSD Operating System (Second Edition)


[ source navigation ] [ diff markup ] [ identifier search ] [ freetext search ] [ file search ] [ list types ] [ track identifier ]

FreeBSD/Linux Kernel Cross Reference
sys/dev/usb/serial/umoscom.c

Version: -  FREEBSD  -  FREEBSD-13-STABLE  -  FREEBSD-13-0  -  FREEBSD-12-STABLE  -  FREEBSD-12-0  -  FREEBSD-11-STABLE  -  FREEBSD-11-0  -  FREEBSD-10-STABLE  -  FREEBSD-10-0  -  FREEBSD-9-STABLE  -  FREEBSD-9-0  -  FREEBSD-8-STABLE  -  FREEBSD-8-0  -  FREEBSD-7-STABLE  -  FREEBSD-7-0  -  FREEBSD-6-STABLE  -  FREEBSD-6-0  -  FREEBSD-5-STABLE  -  FREEBSD-5-0  -  FREEBSD-4-STABLE  -  FREEBSD-3-STABLE  -  FREEBSD22  -  l41  -  OPENBSD  -  linux-2.6  -  MK84  -  PLAN9  -  xnu-8792 
SearchContext: -  none  -  3  -  10 

    1 /* $FreeBSD$ */
    2 /*      $OpenBSD: umoscom.c,v 1.2 2006/10/26 06:02:43 jsg Exp $ */
    3 
    4 /*
    5  * Copyright (c) 2006 Jonathan Gray <jsg@openbsd.org>
    6  *
    7  * Permission to use, copy, modify, and distribute this software for any
    8  * purpose with or without fee is hereby granted, provided that the above
    9  * copyright notice and this permission notice appear in all copies.
   10  *
   11  * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
   12  * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
   13  * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
   14  * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
   15  * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
   16  * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
   17  * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
   18  */
   19 
   20 #include <sys/stdint.h>
   21 #include <sys/stddef.h>
   22 #include <sys/param.h>
   23 #include <sys/queue.h>
   24 #include <sys/types.h>
   25 #include <sys/systm.h>
   26 #include <sys/kernel.h>
   27 #include <sys/bus.h>
   28 #include <sys/module.h>
   29 #include <sys/lock.h>
   30 #include <sys/mutex.h>
   31 #include <sys/condvar.h>
   32 #include <sys/sysctl.h>
   33 #include <sys/sx.h>
   34 #include <sys/unistd.h>
   35 #include <sys/callout.h>
   36 #include <sys/malloc.h>
   37 #include <sys/priv.h>
   38 
   39 #include <dev/usb/usb.h>
   40 #include <dev/usb/usbdi.h>
   41 #include <dev/usb/usbdi_util.h>
   42 #include "usbdevs.h"
   43 
   44 #define USB_DEBUG_VAR umoscom_debug
   45 #include <dev/usb/usb_debug.h>
   46 #include <dev/usb/usb_process.h>
   47 
   48 #include <dev/usb/serial/usb_serial.h>
   49 
   50 #ifdef USB_DEBUG
   51 static int umoscom_debug = 0;
   52 
   53 static SYSCTL_NODE(_hw_usb, OID_AUTO, umoscom, CTLFLAG_RW | CTLFLAG_MPSAFE, 0,
   54     "USB umoscom");
   55 SYSCTL_INT(_hw_usb_umoscom, OID_AUTO, debug, CTLFLAG_RWTUN,
   56     &umoscom_debug, 0, "Debug level");
   57 #endif
   58 
   59 #define UMOSCOM_BUFSIZE        1024     /* bytes */
   60 
   61 #define UMOSCOM_CONFIG_INDEX    0
   62 #define UMOSCOM_IFACE_INDEX     0
   63 
   64 /* interrupt packet */
   65 #define UMOSCOM_IIR_RLS         0x06
   66 #define UMOSCOM_IIR_RDA         0x04
   67 #define UMOSCOM_IIR_CTI         0x0c
   68 #define UMOSCOM_IIR_THR         0x02
   69 #define UMOSCOM_IIR_MS          0x00
   70 
   71 /* registers */
   72 #define UMOSCOM_READ            0x0d
   73 #define UMOSCOM_WRITE           0x0e
   74 #define UMOSCOM_UART_REG        0x0300
   75 #define UMOSCOM_VEND_REG        0x0000
   76 
   77 #define UMOSCOM_TXBUF           0x00    /* Write */
   78 #define UMOSCOM_RXBUF           0x00    /* Read */
   79 #define UMOSCOM_INT             0x01
   80 #define UMOSCOM_FIFO            0x02    /* Write */
   81 #define UMOSCOM_ISR             0x02    /* Read */
   82 #define UMOSCOM_LCR             0x03
   83 #define UMOSCOM_MCR             0x04
   84 #define UMOSCOM_LSR             0x05
   85 #define UMOSCOM_MSR             0x06
   86 #define UMOSCOM_SCRATCH         0x07
   87 #define UMOSCOM_DIV_LO          0x08
   88 #define UMOSCOM_DIV_HI          0x09
   89 #define UMOSCOM_EFR             0x0a
   90 #define UMOSCOM_XON1            0x0b
   91 #define UMOSCOM_XON2            0x0c
   92 #define UMOSCOM_XOFF1           0x0d
   93 #define UMOSCOM_XOFF2           0x0e
   94 
   95 #define UMOSCOM_BAUDLO          0x00
   96 #define UMOSCOM_BAUDHI          0x01
   97 
   98 #define UMOSCOM_INT_RXEN        0x01
   99 #define UMOSCOM_INT_TXEN        0x02
  100 #define UMOSCOM_INT_RSEN        0x04
  101 #define UMOSCOM_INT_MDMEM       0x08
  102 #define UMOSCOM_INT_SLEEP       0x10
  103 #define UMOSCOM_INT_XOFF        0x20
  104 #define UMOSCOM_INT_RTS         0x40
  105 
  106 #define UMOSCOM_FIFO_EN         0x01
  107 #define UMOSCOM_FIFO_RXCLR      0x02
  108 #define UMOSCOM_FIFO_TXCLR      0x04
  109 #define UMOSCOM_FIFO_DMA_BLK    0x08
  110 #define UMOSCOM_FIFO_TXLVL_MASK 0x30
  111 #define UMOSCOM_FIFO_TXLVL_8    0x00
  112 #define UMOSCOM_FIFO_TXLVL_16   0x10
  113 #define UMOSCOM_FIFO_TXLVL_32   0x20
  114 #define UMOSCOM_FIFO_TXLVL_56   0x30
  115 #define UMOSCOM_FIFO_RXLVL_MASK 0xc0
  116 #define UMOSCOM_FIFO_RXLVL_8    0x00
  117 #define UMOSCOM_FIFO_RXLVL_16   0x40
  118 #define UMOSCOM_FIFO_RXLVL_56   0x80
  119 #define UMOSCOM_FIFO_RXLVL_80   0xc0
  120 
  121 #define UMOSCOM_ISR_MDM         0x00
  122 #define UMOSCOM_ISR_NONE        0x01
  123 #define UMOSCOM_ISR_TX          0x02
  124 #define UMOSCOM_ISR_RX          0x04
  125 #define UMOSCOM_ISR_LINE        0x06
  126 #define UMOSCOM_ISR_RXTIMEOUT   0x0c
  127 #define UMOSCOM_ISR_RX_XOFF     0x10
  128 #define UMOSCOM_ISR_RTSCTS      0x20
  129 #define UMOSCOM_ISR_FIFOEN      0xc0
  130 
  131 #define UMOSCOM_LCR_DBITS(x)    ((x) - 5)
  132 #define UMOSCOM_LCR_STOP_BITS_1 0x00
  133 #define UMOSCOM_LCR_STOP_BITS_2 0x04    /* 2 if 6-8 bits/char or 1.5 if 5 */
  134 #define UMOSCOM_LCR_PARITY_NONE 0x00
  135 #define UMOSCOM_LCR_PARITY_ODD  0x08
  136 #define UMOSCOM_LCR_PARITY_EVEN 0x18
  137 #define UMOSCOM_LCR_BREAK       0x40
  138 #define UMOSCOM_LCR_DIVLATCH_EN 0x80
  139 
  140 #define UMOSCOM_MCR_DTR         0x01
  141 #define UMOSCOM_MCR_RTS         0x02
  142 #define UMOSCOM_MCR_LOOP        0x04
  143 #define UMOSCOM_MCR_INTEN       0x08
  144 #define UMOSCOM_MCR_LOOPBACK    0x10
  145 #define UMOSCOM_MCR_XONANY      0x20
  146 #define UMOSCOM_MCR_IRDA_EN     0x40
  147 #define UMOSCOM_MCR_BAUD_DIV4   0x80
  148 
  149 #define UMOSCOM_LSR_RXDATA      0x01
  150 #define UMOSCOM_LSR_RXOVER      0x02
  151 #define UMOSCOM_LSR_RXPAR_ERR   0x04
  152 #define UMOSCOM_LSR_RXFRM_ERR   0x08
  153 #define UMOSCOM_LSR_RXBREAK     0x10
  154 #define UMOSCOM_LSR_TXEMPTY     0x20
  155 #define UMOSCOM_LSR_TXALLEMPTY  0x40
  156 #define UMOSCOM_LSR_TXFIFO_ERR  0x80
  157 
  158 #define UMOSCOM_MSR_CTS_CHG     0x01
  159 #define UMOSCOM_MSR_DSR_CHG     0x02
  160 #define UMOSCOM_MSR_RI_CHG      0x04
  161 #define UMOSCOM_MSR_CD_CHG      0x08
  162 #define UMOSCOM_MSR_CTS         0x10
  163 #define UMOSCOM_MSR_RTS         0x20
  164 #define UMOSCOM_MSR_RI          0x40
  165 #define UMOSCOM_MSR_CD          0x80
  166 
  167 #define UMOSCOM_BAUD_REF        115200
  168 
  169 enum {
  170         UMOSCOM_BULK_DT_WR,
  171         UMOSCOM_BULK_DT_RD,
  172         UMOSCOM_INTR_DT_RD,
  173         UMOSCOM_N_TRANSFER,
  174 };
  175 
  176 struct umoscom_softc {
  177         struct ucom_super_softc sc_super_ucom;
  178         struct ucom_softc sc_ucom;
  179 
  180         struct usb_xfer *sc_xfer[UMOSCOM_N_TRANSFER];
  181         struct usb_device *sc_udev;
  182         struct mtx sc_mtx;
  183 
  184         uint8_t sc_mcr;
  185         uint8_t sc_lcr;
  186 };
  187 
  188 /* prototypes */
  189 
  190 static device_probe_t umoscom_probe;
  191 static device_attach_t umoscom_attach;
  192 static device_detach_t umoscom_detach;
  193 static void umoscom_free_softc(struct umoscom_softc *);
  194 
  195 static usb_callback_t umoscom_write_callback;
  196 static usb_callback_t umoscom_read_callback;
  197 static usb_callback_t umoscom_intr_callback;
  198 
  199 static void     umoscom_free(struct ucom_softc *);
  200 static void     umoscom_cfg_open(struct ucom_softc *);
  201 static void     umoscom_cfg_close(struct ucom_softc *);
  202 static void     umoscom_cfg_set_break(struct ucom_softc *, uint8_t);
  203 static void     umoscom_cfg_set_dtr(struct ucom_softc *, uint8_t);
  204 static void     umoscom_cfg_set_rts(struct ucom_softc *, uint8_t);
  205 static int      umoscom_pre_param(struct ucom_softc *, struct termios *);
  206 static void     umoscom_cfg_param(struct ucom_softc *, struct termios *);
  207 static void     umoscom_cfg_get_status(struct ucom_softc *, uint8_t *,
  208                     uint8_t *);
  209 static void     umoscom_cfg_write(struct umoscom_softc *, uint16_t, uint16_t);
  210 static uint8_t  umoscom_cfg_read(struct umoscom_softc *, uint16_t);
  211 static void     umoscom_start_read(struct ucom_softc *);
  212 static void     umoscom_stop_read(struct ucom_softc *);
  213 static void     umoscom_start_write(struct ucom_softc *);
  214 static void     umoscom_stop_write(struct ucom_softc *);
  215 static void     umoscom_poll(struct ucom_softc *ucom);
  216 
  217 static const struct usb_config umoscom_config_data[UMOSCOM_N_TRANSFER] = {
  218         [UMOSCOM_BULK_DT_WR] = {
  219                 .type = UE_BULK,
  220                 .endpoint = UE_ADDR_ANY,
  221                 .direction = UE_DIR_OUT,
  222                 .bufsize = UMOSCOM_BUFSIZE,
  223                 .flags = {.pipe_bof = 1,.force_short_xfer = 1,},
  224                 .callback = &umoscom_write_callback,
  225         },
  226 
  227         [UMOSCOM_BULK_DT_RD] = {
  228                 .type = UE_BULK,
  229                 .endpoint = UE_ADDR_ANY,
  230                 .direction = UE_DIR_IN,
  231                 .bufsize = UMOSCOM_BUFSIZE,
  232                 .flags = {.pipe_bof = 1,.short_xfer_ok = 1,},
  233                 .callback = &umoscom_read_callback,
  234         },
  235 
  236         [UMOSCOM_INTR_DT_RD] = {
  237                 .type = UE_INTERRUPT,
  238                 .endpoint = UE_ADDR_ANY,
  239                 .direction = UE_DIR_IN,
  240                 .flags = {.pipe_bof = 1,.short_xfer_ok = 1,},
  241                 .bufsize = 0,   /* use wMaxPacketSize */
  242                 .callback = &umoscom_intr_callback,
  243         },
  244 };
  245 
  246 static const struct ucom_callback umoscom_callback = {
  247         /* configuration callbacks */
  248         .ucom_cfg_get_status = &umoscom_cfg_get_status,
  249         .ucom_cfg_set_dtr = &umoscom_cfg_set_dtr,
  250         .ucom_cfg_set_rts = &umoscom_cfg_set_rts,
  251         .ucom_cfg_set_break = &umoscom_cfg_set_break,
  252         .ucom_cfg_param = &umoscom_cfg_param,
  253         .ucom_cfg_open = &umoscom_cfg_open,
  254         .ucom_cfg_close = &umoscom_cfg_close,
  255 
  256         /* other callbacks */
  257         .ucom_pre_param = &umoscom_pre_param,
  258         .ucom_start_read = &umoscom_start_read,
  259         .ucom_stop_read = &umoscom_stop_read,
  260         .ucom_start_write = &umoscom_start_write,
  261         .ucom_stop_write = &umoscom_stop_write,
  262         .ucom_poll = &umoscom_poll,
  263         .ucom_free = &umoscom_free,
  264 };
  265 
  266 static device_method_t umoscom_methods[] = {
  267         DEVMETHOD(device_probe, umoscom_probe),
  268         DEVMETHOD(device_attach, umoscom_attach),
  269         DEVMETHOD(device_detach, umoscom_detach),
  270         DEVMETHOD_END
  271 };
  272 
  273 static driver_t umoscom_driver = {
  274         .name = "umoscom",
  275         .methods = umoscom_methods,
  276         .size = sizeof(struct umoscom_softc),
  277 };
  278 
  279 static const STRUCT_USB_HOST_ID umoscom_devs[] = {
  280         {USB_VPI(USB_VENDOR_MOSCHIP, USB_PRODUCT_MOSCHIP_MCS7703, 0)}
  281 };
  282 
  283 DRIVER_MODULE(umoscom, uhub, umoscom_driver, NULL, NULL);
  284 MODULE_DEPEND(umoscom, ucom, 1, 1, 1);
  285 MODULE_DEPEND(umoscom, usb, 1, 1, 1);
  286 MODULE_VERSION(umoscom, 1);
  287 USB_PNP_HOST_INFO(umoscom_devs);
  288 
  289 static int
  290 umoscom_probe(device_t dev)
  291 {
  292         struct usb_attach_arg *uaa = device_get_ivars(dev);
  293 
  294         if (uaa->usb_mode != USB_MODE_HOST) {
  295                 return (ENXIO);
  296         }
  297         if (uaa->info.bConfigIndex != UMOSCOM_CONFIG_INDEX) {
  298                 return (ENXIO);
  299         }
  300         if (uaa->info.bIfaceIndex != UMOSCOM_IFACE_INDEX) {
  301                 return (ENXIO);
  302         }
  303         return (usbd_lookup_id_by_uaa(umoscom_devs, sizeof(umoscom_devs), uaa));
  304 }
  305 
  306 static int
  307 umoscom_attach(device_t dev)
  308 {
  309         struct usb_attach_arg *uaa = device_get_ivars(dev);
  310         struct umoscom_softc *sc = device_get_softc(dev);
  311         int error;
  312         uint8_t iface_index;
  313 
  314         sc->sc_udev = uaa->device;
  315         sc->sc_mcr = 0x08;              /* enable interrupts */
  316 
  317         /* XXX the device doesn't provide any ID string, so set a static one */
  318         device_set_desc(dev, "MOSCHIP USB Serial Port Adapter");
  319         device_printf(dev, "<MOSCHIP USB Serial Port Adapter>\n");
  320 
  321         mtx_init(&sc->sc_mtx, "umoscom", NULL, MTX_DEF);
  322         ucom_ref(&sc->sc_super_ucom);
  323 
  324         iface_index = UMOSCOM_IFACE_INDEX;
  325         error = usbd_transfer_setup(uaa->device, &iface_index,
  326             sc->sc_xfer, umoscom_config_data,
  327             UMOSCOM_N_TRANSFER, sc, &sc->sc_mtx);
  328 
  329         if (error) {
  330                 goto detach;
  331         }
  332         /* clear stall at first run */
  333         mtx_lock(&sc->sc_mtx);
  334         usbd_xfer_set_stall(sc->sc_xfer[UMOSCOM_BULK_DT_WR]);
  335         usbd_xfer_set_stall(sc->sc_xfer[UMOSCOM_BULK_DT_RD]);
  336         mtx_unlock(&sc->sc_mtx);
  337 
  338         error = ucom_attach(&sc->sc_super_ucom, &sc->sc_ucom, 1, sc,
  339             &umoscom_callback, &sc->sc_mtx);
  340         if (error) {
  341                 goto detach;
  342         }
  343         ucom_set_pnpinfo_usb(&sc->sc_super_ucom, dev);
  344 
  345         return (0);
  346 
  347 detach:
  348         device_printf(dev, "attach error: %s\n", usbd_errstr(error));
  349         umoscom_detach(dev);
  350         return (ENXIO);
  351 }
  352 
  353 static int
  354 umoscom_detach(device_t dev)
  355 {
  356         struct umoscom_softc *sc = device_get_softc(dev);
  357 
  358         ucom_detach(&sc->sc_super_ucom, &sc->sc_ucom);
  359         usbd_transfer_unsetup(sc->sc_xfer, UMOSCOM_N_TRANSFER);
  360 
  361         device_claim_softc(dev);
  362 
  363         umoscom_free_softc(sc);
  364 
  365         return (0);
  366 }
  367 
  368 UCOM_UNLOAD_DRAIN(umoscom);
  369 
  370 static void
  371 umoscom_free_softc(struct umoscom_softc *sc)
  372 {
  373         if (ucom_unref(&sc->sc_super_ucom)) {
  374                 mtx_destroy(&sc->sc_mtx);
  375                 device_free_softc(sc);
  376         }
  377 }
  378 
  379 static void
  380 umoscom_free(struct ucom_softc *ucom)
  381 {
  382         umoscom_free_softc(ucom->sc_parent);
  383 }
  384 
  385 static void
  386 umoscom_cfg_open(struct ucom_softc *ucom)
  387 {
  388         struct umoscom_softc *sc = ucom->sc_parent;
  389 
  390         DPRINTF("\n");
  391 
  392         /* Purge FIFOs or odd things happen */
  393         umoscom_cfg_write(sc, UMOSCOM_FIFO, 0x00 | UMOSCOM_UART_REG);
  394 
  395         /* Enable FIFO */
  396         umoscom_cfg_write(sc, UMOSCOM_FIFO, UMOSCOM_FIFO_EN |
  397             UMOSCOM_FIFO_RXCLR | UMOSCOM_FIFO_TXCLR |
  398             UMOSCOM_FIFO_DMA_BLK | UMOSCOM_FIFO_RXLVL_MASK |
  399             UMOSCOM_UART_REG);
  400 
  401         /* Enable Interrupt Registers */
  402         umoscom_cfg_write(sc, UMOSCOM_INT, 0x0C | UMOSCOM_UART_REG);
  403 
  404         /* Magic */
  405         umoscom_cfg_write(sc, 0x01, 0x08);
  406 
  407         /* Magic */
  408         umoscom_cfg_write(sc, 0x00, 0x02);
  409 }
  410 
  411 static void
  412 umoscom_cfg_close(struct ucom_softc *ucom)
  413 {
  414         return;
  415 }
  416 
  417 static void
  418 umoscom_cfg_set_break(struct ucom_softc *ucom, uint8_t onoff)
  419 {
  420         struct umoscom_softc *sc = ucom->sc_parent;
  421         uint16_t val;
  422 
  423         val = sc->sc_lcr;
  424         if (onoff)
  425                 val |= UMOSCOM_LCR_BREAK;
  426 
  427         umoscom_cfg_write(sc, UMOSCOM_LCR, val | UMOSCOM_UART_REG);
  428 }
  429 
  430 static void
  431 umoscom_cfg_set_dtr(struct ucom_softc *ucom, uint8_t onoff)
  432 {
  433         struct umoscom_softc *sc = ucom->sc_parent;
  434 
  435         if (onoff)
  436                 sc->sc_mcr |= UMOSCOM_MCR_DTR;
  437         else
  438                 sc->sc_mcr &= ~UMOSCOM_MCR_DTR;
  439 
  440         umoscom_cfg_write(sc, UMOSCOM_MCR, sc->sc_mcr | UMOSCOM_UART_REG);
  441 }
  442 
  443 static void
  444 umoscom_cfg_set_rts(struct ucom_softc *ucom, uint8_t onoff)
  445 {
  446         struct umoscom_softc *sc = ucom->sc_parent;
  447 
  448         if (onoff)
  449                 sc->sc_mcr |= UMOSCOM_MCR_RTS;
  450         else
  451                 sc->sc_mcr &= ~UMOSCOM_MCR_RTS;
  452 
  453         umoscom_cfg_write(sc, UMOSCOM_MCR, sc->sc_mcr | UMOSCOM_UART_REG);
  454 }
  455 
  456 static int
  457 umoscom_pre_param(struct ucom_softc *ucom, struct termios *t)
  458 {
  459         if ((t->c_ospeed <= 1) || (t->c_ospeed > 115200))
  460                 return (EINVAL);
  461 
  462         return (0);
  463 }
  464 
  465 static void
  466 umoscom_cfg_param(struct ucom_softc *ucom, struct termios *t)
  467 {
  468         struct umoscom_softc *sc = ucom->sc_parent;
  469         uint16_t data;
  470 
  471         DPRINTF("speed=%d\n", t->c_ospeed);
  472 
  473         data = ((uint32_t)UMOSCOM_BAUD_REF) / ((uint32_t)t->c_ospeed);
  474 
  475         if (data == 0) {
  476                 DPRINTF("invalid baud rate!\n");
  477                 return;
  478         }
  479         umoscom_cfg_write(sc, UMOSCOM_LCR,
  480             UMOSCOM_LCR_DIVLATCH_EN | UMOSCOM_UART_REG);
  481 
  482         umoscom_cfg_write(sc, UMOSCOM_BAUDLO,
  483             (data & 0xFF) | UMOSCOM_UART_REG);
  484 
  485         umoscom_cfg_write(sc, UMOSCOM_BAUDHI,
  486             ((data >> 8) & 0xFF) | UMOSCOM_UART_REG);
  487 
  488         if (t->c_cflag & CSTOPB)
  489                 data = UMOSCOM_LCR_STOP_BITS_2;
  490         else
  491                 data = UMOSCOM_LCR_STOP_BITS_1;
  492 
  493         if (t->c_cflag & PARENB) {
  494                 if (t->c_cflag & PARODD)
  495                         data |= UMOSCOM_LCR_PARITY_ODD;
  496                 else
  497                         data |= UMOSCOM_LCR_PARITY_EVEN;
  498         } else
  499                 data |= UMOSCOM_LCR_PARITY_NONE;
  500 
  501         switch (t->c_cflag & CSIZE) {
  502         case CS5:
  503                 data |= UMOSCOM_LCR_DBITS(5);
  504                 break;
  505         case CS6:
  506                 data |= UMOSCOM_LCR_DBITS(6);
  507                 break;
  508         case CS7:
  509                 data |= UMOSCOM_LCR_DBITS(7);
  510                 break;
  511         case CS8:
  512                 data |= UMOSCOM_LCR_DBITS(8);
  513                 break;
  514         }
  515 
  516         sc->sc_lcr = data;
  517         umoscom_cfg_write(sc, UMOSCOM_LCR, data | UMOSCOM_UART_REG);
  518 }
  519 
  520 static void
  521 umoscom_cfg_get_status(struct ucom_softc *ucom, uint8_t *p_lsr, uint8_t *p_msr)
  522 {
  523         struct umoscom_softc *sc = ucom->sc_parent;
  524         uint8_t msr;
  525 
  526         DPRINTFN(5, "\n");
  527 
  528         /*
  529          * Read status registers.  MSR bits need translation from ns16550 to
  530          * SER_* values.  LSR bits are ns16550 in hardware and ucom.
  531          */
  532 
  533         *p_lsr = umoscom_cfg_read(sc, UMOSCOM_LSR);
  534         msr = umoscom_cfg_read(sc, UMOSCOM_MSR);
  535 
  536         /* translate bits */
  537 
  538         if (msr & UMOSCOM_MSR_CTS)
  539                 *p_msr |= SER_CTS;
  540 
  541         if (msr & UMOSCOM_MSR_CD)
  542                 *p_msr |= SER_DCD;
  543 
  544         if (msr & UMOSCOM_MSR_RI)
  545                 *p_msr |= SER_RI;
  546 
  547         if (msr & UMOSCOM_MSR_RTS)
  548                 *p_msr |= SER_DSR;
  549 }
  550 
  551 static void
  552 umoscom_cfg_write(struct umoscom_softc *sc, uint16_t reg, uint16_t val)
  553 {
  554         struct usb_device_request req;
  555 
  556         req.bmRequestType = UT_WRITE_VENDOR_DEVICE;
  557         req.bRequest = UMOSCOM_WRITE;
  558         USETW(req.wValue, val);
  559         USETW(req.wIndex, reg);
  560         USETW(req.wLength, 0);
  561 
  562         ucom_cfg_do_request(sc->sc_udev, &sc->sc_ucom,
  563             &req, NULL, 0, 1000);
  564 }
  565 
  566 static uint8_t
  567 umoscom_cfg_read(struct umoscom_softc *sc, uint16_t reg)
  568 {
  569         struct usb_device_request req;
  570         uint8_t val;
  571 
  572         req.bmRequestType = UT_READ_VENDOR_DEVICE;
  573         req.bRequest = UMOSCOM_READ;
  574         USETW(req.wValue, 0);
  575         USETW(req.wIndex, reg);
  576         USETW(req.wLength, 1);
  577 
  578         ucom_cfg_do_request(sc->sc_udev, &sc->sc_ucom, 
  579             &req, &val, 0, 1000);
  580 
  581         DPRINTF("reg=0x%04x, val=0x%02x\n", reg, val);
  582 
  583         return (val);
  584 }
  585 
  586 static void
  587 umoscom_start_read(struct ucom_softc *ucom)
  588 {
  589         struct umoscom_softc *sc = ucom->sc_parent;
  590 
  591 #if 0
  592         /* start interrupt endpoint */
  593         usbd_transfer_start(sc->sc_xfer[UMOSCOM_INTR_DT_RD]);
  594 #endif
  595         /* start read endpoint */
  596         usbd_transfer_start(sc->sc_xfer[UMOSCOM_BULK_DT_RD]);
  597 }
  598 
  599 static void
  600 umoscom_stop_read(struct ucom_softc *ucom)
  601 {
  602         struct umoscom_softc *sc = ucom->sc_parent;
  603 
  604         /* stop interrupt transfer */
  605         usbd_transfer_stop(sc->sc_xfer[UMOSCOM_INTR_DT_RD]);
  606 
  607         /* stop read endpoint */
  608         usbd_transfer_stop(sc->sc_xfer[UMOSCOM_BULK_DT_RD]);
  609 }
  610 
  611 static void
  612 umoscom_start_write(struct ucom_softc *ucom)
  613 {
  614         struct umoscom_softc *sc = ucom->sc_parent;
  615 
  616         usbd_transfer_start(sc->sc_xfer[UMOSCOM_BULK_DT_WR]);
  617 }
  618 
  619 static void
  620 umoscom_stop_write(struct ucom_softc *ucom)
  621 {
  622         struct umoscom_softc *sc = ucom->sc_parent;
  623 
  624         usbd_transfer_stop(sc->sc_xfer[UMOSCOM_BULK_DT_WR]);
  625 }
  626 
  627 static void
  628 umoscom_write_callback(struct usb_xfer *xfer, usb_error_t error)
  629 {
  630         struct umoscom_softc *sc = usbd_xfer_softc(xfer);
  631         struct usb_page_cache *pc;
  632         uint32_t actlen;
  633 
  634         switch (USB_GET_STATE(xfer)) {
  635         case USB_ST_SETUP:
  636         case USB_ST_TRANSFERRED:
  637 tr_setup:
  638                 DPRINTF("\n");
  639 
  640                 pc = usbd_xfer_get_frame(xfer, 0);
  641                 if (ucom_get_data(&sc->sc_ucom, pc, 0,
  642                     UMOSCOM_BUFSIZE, &actlen)) {
  643                         usbd_xfer_set_frame_len(xfer, 0, actlen);
  644                         usbd_transfer_submit(xfer);
  645                 }
  646                 return;
  647 
  648         default:                        /* Error */
  649                 if (error != USB_ERR_CANCELLED) {
  650                         DPRINTFN(0, "transfer failed\n");
  651                         /* try to clear stall first */
  652                         usbd_xfer_set_stall(xfer);
  653                         goto tr_setup;
  654                 }
  655                 return;
  656         }
  657 }
  658 
  659 static void
  660 umoscom_read_callback(struct usb_xfer *xfer, usb_error_t error)
  661 {
  662         struct umoscom_softc *sc = usbd_xfer_softc(xfer);
  663         struct usb_page_cache *pc;
  664         int actlen;
  665 
  666         usbd_xfer_status(xfer, &actlen, NULL, NULL, NULL);
  667 
  668         switch (USB_GET_STATE(xfer)) {
  669         case USB_ST_TRANSFERRED:
  670                 DPRINTF("got %d bytes\n", actlen);
  671                 pc = usbd_xfer_get_frame(xfer, 0);
  672                 ucom_put_data(&sc->sc_ucom, pc, 0, actlen);
  673 
  674         case USB_ST_SETUP:
  675 tr_setup:
  676                 DPRINTF("\n");
  677 
  678                 usbd_xfer_set_frame_len(xfer, 0, usbd_xfer_max_len(xfer));
  679                 usbd_transfer_submit(xfer);
  680                 return;
  681 
  682         default:                        /* Error */
  683                 if (error != USB_ERR_CANCELLED) {
  684                         DPRINTFN(0, "transfer failed\n");
  685                         /* try to clear stall first */
  686                         usbd_xfer_set_stall(xfer);
  687                         goto tr_setup;
  688                 }
  689                 return;
  690         }
  691 }
  692 
  693 static void
  694 umoscom_intr_callback(struct usb_xfer *xfer, usb_error_t error)
  695 {
  696         struct umoscom_softc *sc = usbd_xfer_softc(xfer);
  697         int actlen;
  698 
  699         usbd_xfer_status(xfer, &actlen, NULL, NULL, NULL);
  700 
  701         switch (USB_GET_STATE(xfer)) {
  702         case USB_ST_TRANSFERRED:
  703                 if (actlen < 2) {
  704                         DPRINTF("too short message\n");
  705                         goto tr_setup;
  706                 }
  707                 ucom_status_change(&sc->sc_ucom);
  708 
  709         case USB_ST_SETUP:
  710 tr_setup:
  711                 usbd_xfer_set_frame_len(xfer, 0, usbd_xfer_max_len(xfer));
  712                 usbd_transfer_submit(xfer);
  713                 return;
  714 
  715         default:                        /* Error */
  716                 if (error != USB_ERR_CANCELLED) {
  717                         DPRINTFN(0, "transfer failed\n");
  718                         /* try to clear stall first */
  719                         usbd_xfer_set_stall(xfer);
  720                         goto tr_setup;
  721                 }
  722                 return;
  723         }
  724 }
  725 
  726 static void
  727 umoscom_poll(struct ucom_softc *ucom)
  728 {
  729         struct umoscom_softc *sc = ucom->sc_parent;
  730         usbd_transfer_poll(sc->sc_xfer, UMOSCOM_N_TRANSFER);
  731 }

Cache object: 5fe9ea7fc91775e17f7e19e90592c556


[ source navigation ] [ diff markup ] [ identifier search ] [ freetext search ] [ file search ] [ list types ] [ track identifier ]


This page is part of the FreeBSD/Linux Linux Kernel Cross-Reference, and was automatically generated using a modified version of the LXR engine.