102ac6454SAndrew Thompson /* $OpenBSD: uark.c,v 1.1 2006/08/14 08:30:22 jsg Exp $ */ 202ac6454SAndrew Thompson 302ac6454SAndrew Thompson /* 402ac6454SAndrew Thompson * Copyright (c) 2006 Jonathan Gray <jsg@openbsd.org> 502ac6454SAndrew Thompson * 602ac6454SAndrew Thompson * Permission to use, copy, modify, and distribute this software for any 702ac6454SAndrew Thompson * purpose with or without fee is hereby granted, provided that the above 802ac6454SAndrew Thompson * copyright notice and this permission notice appear in all copies. 902ac6454SAndrew Thompson * 1002ac6454SAndrew Thompson * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES 1102ac6454SAndrew Thompson * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF 1202ac6454SAndrew Thompson * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR 1302ac6454SAndrew Thompson * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES 1402ac6454SAndrew Thompson * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN 1502ac6454SAndrew Thompson * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF 1602ac6454SAndrew Thompson * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE. 1702ac6454SAndrew Thompson * 1802ac6454SAndrew Thompson * $FreeBSD$ 1902ac6454SAndrew Thompson */ 2002ac6454SAndrew Thompson 2102ac6454SAndrew Thompson /* 2202ac6454SAndrew Thompson * NOTE: all function names beginning like "uark_cfg_" can only 2302ac6454SAndrew Thompson * be called from within the config thread function ! 2402ac6454SAndrew Thompson */ 2502ac6454SAndrew Thompson 26ed6d949aSAndrew Thompson 27ed6d949aSAndrew Thompson #include <sys/stdint.h> 28ed6d949aSAndrew Thompson #include <sys/stddef.h> 29ed6d949aSAndrew Thompson #include <sys/param.h> 30ed6d949aSAndrew Thompson #include <sys/queue.h> 31ed6d949aSAndrew Thompson #include <sys/types.h> 32ed6d949aSAndrew Thompson #include <sys/systm.h> 33ed6d949aSAndrew Thompson #include <sys/kernel.h> 34ed6d949aSAndrew Thompson #include <sys/bus.h> 35ed6d949aSAndrew Thompson #include <sys/linker_set.h> 36ed6d949aSAndrew Thompson #include <sys/module.h> 37ed6d949aSAndrew Thompson #include <sys/lock.h> 38ed6d949aSAndrew Thompson #include <sys/mutex.h> 39ed6d949aSAndrew Thompson #include <sys/condvar.h> 40ed6d949aSAndrew Thompson #include <sys/sysctl.h> 41ed6d949aSAndrew Thompson #include <sys/sx.h> 42ed6d949aSAndrew Thompson #include <sys/unistd.h> 43ed6d949aSAndrew Thompson #include <sys/callout.h> 44ed6d949aSAndrew Thompson #include <sys/malloc.h> 45ed6d949aSAndrew Thompson #include <sys/priv.h> 46ed6d949aSAndrew Thompson 4702ac6454SAndrew Thompson #include <dev/usb/usb.h> 48ed6d949aSAndrew Thompson #include <dev/usb/usbdi.h> 49ed6d949aSAndrew Thompson #include <dev/usb/usbdi_util.h> 50ed6d949aSAndrew Thompson #include <dev/usb/usbhid.h> 51ed6d949aSAndrew Thompson #include "usbdevs.h" 5202ac6454SAndrew Thompson 53a593f6b8SAndrew Thompson #define USB_DEBUG_VAR usb_debug 5402ac6454SAndrew Thompson #include <dev/usb/usb_debug.h> 5502ac6454SAndrew Thompson #include <dev/usb/usb_process.h> 5602ac6454SAndrew Thompson 5702ac6454SAndrew Thompson #include <dev/usb/serial/usb_serial.h> 5802ac6454SAndrew Thompson 5902ac6454SAndrew Thompson #define UARK_BUF_SIZE 1024 /* bytes */ 6002ac6454SAndrew Thompson 6102ac6454SAndrew Thompson #define UARK_SET_DATA_BITS(x) ((x) - 5) 6202ac6454SAndrew Thompson 6302ac6454SAndrew Thompson #define UARK_PARITY_NONE 0x00 6402ac6454SAndrew Thompson #define UARK_PARITY_ODD 0x08 6502ac6454SAndrew Thompson #define UARK_PARITY_EVEN 0x18 6602ac6454SAndrew Thompson 6702ac6454SAndrew Thompson #define UARK_STOP_BITS_1 0x00 6802ac6454SAndrew Thompson #define UARK_STOP_BITS_2 0x04 6902ac6454SAndrew Thompson 7002ac6454SAndrew Thompson #define UARK_BAUD_REF 3000000 7102ac6454SAndrew Thompson 7202ac6454SAndrew Thompson #define UARK_WRITE 0x40 7302ac6454SAndrew Thompson #define UARK_READ 0xc0 7402ac6454SAndrew Thompson 7502ac6454SAndrew Thompson #define UARK_REQUEST 0xfe 7602ac6454SAndrew Thompson 7702ac6454SAndrew Thompson #define UARK_CONFIG_INDEX 0 7802ac6454SAndrew Thompson #define UARK_IFACE_INDEX 0 7902ac6454SAndrew Thompson 8002ac6454SAndrew Thompson enum { 8102ac6454SAndrew Thompson UARK_BULK_DT_WR, 8202ac6454SAndrew Thompson UARK_BULK_DT_RD, 8302ac6454SAndrew Thompson UARK_N_TRANSFER, 8402ac6454SAndrew Thompson }; 8502ac6454SAndrew Thompson 8602ac6454SAndrew Thompson struct uark_softc { 87760bc48eSAndrew Thompson struct ucom_super_softc sc_super_ucom; 88760bc48eSAndrew Thompson struct ucom_softc sc_ucom; 8902ac6454SAndrew Thompson 90760bc48eSAndrew Thompson struct usb_xfer *sc_xfer[UARK_N_TRANSFER]; 91760bc48eSAndrew Thompson struct usb_device *sc_udev; 92deefe583SAndrew Thompson struct mtx sc_mtx; 9302ac6454SAndrew Thompson 9402ac6454SAndrew Thompson uint8_t sc_msr; 9502ac6454SAndrew Thompson uint8_t sc_lsr; 9602ac6454SAndrew Thompson }; 9702ac6454SAndrew Thompson 9802ac6454SAndrew Thompson /* prototypes */ 9902ac6454SAndrew Thompson 10002ac6454SAndrew Thompson static device_probe_t uark_probe; 10102ac6454SAndrew Thompson static device_attach_t uark_attach; 10202ac6454SAndrew Thompson static device_detach_t uark_detach; 10302ac6454SAndrew Thompson 104e0a69b51SAndrew Thompson static usb_callback_t uark_bulk_write_callback; 105e0a69b51SAndrew Thompson static usb_callback_t uark_bulk_read_callback; 10602ac6454SAndrew Thompson 107760bc48eSAndrew Thompson static void uark_start_read(struct ucom_softc *); 108760bc48eSAndrew Thompson static void uark_stop_read(struct ucom_softc *); 109760bc48eSAndrew Thompson static void uark_start_write(struct ucom_softc *); 110760bc48eSAndrew Thompson static void uark_stop_write(struct ucom_softc *); 111760bc48eSAndrew Thompson static int uark_pre_param(struct ucom_softc *, struct termios *); 112760bc48eSAndrew Thompson static void uark_cfg_param(struct ucom_softc *, struct termios *); 113760bc48eSAndrew Thompson static void uark_cfg_get_status(struct ucom_softc *, uint8_t *, 11402ac6454SAndrew Thompson uint8_t *); 115760bc48eSAndrew Thompson static void uark_cfg_set_break(struct ucom_softc *, uint8_t); 11602ac6454SAndrew Thompson static void uark_cfg_write(struct uark_softc *, uint16_t, uint16_t); 117655dc9d0SAndrew Thompson static void uark_poll(struct ucom_softc *ucom); 11802ac6454SAndrew Thompson 119760bc48eSAndrew Thompson static const struct usb_config 12002ac6454SAndrew Thompson uark_xfer_config[UARK_N_TRANSFER] = { 12102ac6454SAndrew Thompson 12202ac6454SAndrew Thompson [UARK_BULK_DT_WR] = { 12302ac6454SAndrew Thompson .type = UE_BULK, 12402ac6454SAndrew Thompson .endpoint = UE_ADDR_ANY, 12502ac6454SAndrew Thompson .direction = UE_DIR_OUT, 1264eae601eSAndrew Thompson .bufsize = UARK_BUF_SIZE, 1274eae601eSAndrew Thompson .flags = {.pipe_bof = 1,.force_short_xfer = 1,}, 1284eae601eSAndrew Thompson .callback = &uark_bulk_write_callback, 12902ac6454SAndrew Thompson }, 13002ac6454SAndrew Thompson 13102ac6454SAndrew Thompson [UARK_BULK_DT_RD] = { 13202ac6454SAndrew Thompson .type = UE_BULK, 13302ac6454SAndrew Thompson .endpoint = UE_ADDR_ANY, 13402ac6454SAndrew Thompson .direction = UE_DIR_IN, 1354eae601eSAndrew Thompson .bufsize = UARK_BUF_SIZE, 1364eae601eSAndrew Thompson .flags = {.pipe_bof = 1,.short_xfer_ok = 1,}, 1374eae601eSAndrew Thompson .callback = &uark_bulk_read_callback, 13802ac6454SAndrew Thompson }, 13902ac6454SAndrew Thompson }; 14002ac6454SAndrew Thompson 141760bc48eSAndrew Thompson static const struct ucom_callback uark_callback = { 142a593f6b8SAndrew Thompson .ucom_cfg_get_status = &uark_cfg_get_status, 143a593f6b8SAndrew Thompson .ucom_cfg_set_break = &uark_cfg_set_break, 144a593f6b8SAndrew Thompson .ucom_cfg_param = &uark_cfg_param, 145a593f6b8SAndrew Thompson .ucom_pre_param = &uark_pre_param, 146a593f6b8SAndrew Thompson .ucom_start_read = &uark_start_read, 147a593f6b8SAndrew Thompson .ucom_stop_read = &uark_stop_read, 148a593f6b8SAndrew Thompson .ucom_start_write = &uark_start_write, 149a593f6b8SAndrew Thompson .ucom_stop_write = &uark_stop_write, 150655dc9d0SAndrew Thompson .ucom_poll = &uark_poll, 15102ac6454SAndrew Thompson }; 15202ac6454SAndrew Thompson 15302ac6454SAndrew Thompson static device_method_t uark_methods[] = { 15402ac6454SAndrew Thompson /* Device methods */ 15502ac6454SAndrew Thompson DEVMETHOD(device_probe, uark_probe), 15602ac6454SAndrew Thompson DEVMETHOD(device_attach, uark_attach), 15702ac6454SAndrew Thompson DEVMETHOD(device_detach, uark_detach), 15802ac6454SAndrew Thompson {0, 0} 15902ac6454SAndrew Thompson }; 16002ac6454SAndrew Thompson 16102ac6454SAndrew Thompson static devclass_t uark_devclass; 16202ac6454SAndrew Thompson 16302ac6454SAndrew Thompson static driver_t uark_driver = { 16402ac6454SAndrew Thompson .name = "uark", 16502ac6454SAndrew Thompson .methods = uark_methods, 16602ac6454SAndrew Thompson .size = sizeof(struct uark_softc), 16702ac6454SAndrew Thompson }; 16802ac6454SAndrew Thompson 1699aef556dSAndrew Thompson DRIVER_MODULE(uark, uhub, uark_driver, uark_devclass, NULL, 0); 17002ac6454SAndrew Thompson MODULE_DEPEND(uark, ucom, 1, 1, 1); 17102ac6454SAndrew Thompson MODULE_DEPEND(uark, usb, 1, 1, 1); 17202ac6454SAndrew Thompson 173760bc48eSAndrew Thompson static const struct usb_device_id uark_devs[] = { 17402ac6454SAndrew Thompson {USB_VPI(USB_VENDOR_ARKMICRO, USB_PRODUCT_ARKMICRO_ARK3116, 0)}, 17502ac6454SAndrew Thompson }; 17602ac6454SAndrew Thompson 17702ac6454SAndrew Thompson static int 17802ac6454SAndrew Thompson uark_probe(device_t dev) 17902ac6454SAndrew Thompson { 180760bc48eSAndrew Thompson struct usb_attach_arg *uaa = device_get_ivars(dev); 18102ac6454SAndrew Thompson 182f29a0724SAndrew Thompson if (uaa->usb_mode != USB_MODE_HOST) { 18302ac6454SAndrew Thompson return (ENXIO); 18402ac6454SAndrew Thompson } 18502ac6454SAndrew Thompson if (uaa->info.bConfigIndex != 0) { 18602ac6454SAndrew Thompson return (ENXIO); 18702ac6454SAndrew Thompson } 18802ac6454SAndrew Thompson if (uaa->info.bIfaceIndex != UARK_IFACE_INDEX) { 18902ac6454SAndrew Thompson return (ENXIO); 19002ac6454SAndrew Thompson } 191a593f6b8SAndrew Thompson return (usbd_lookup_id_by_uaa(uark_devs, sizeof(uark_devs), uaa)); 19202ac6454SAndrew Thompson } 19302ac6454SAndrew Thompson 19402ac6454SAndrew Thompson static int 19502ac6454SAndrew Thompson uark_attach(device_t dev) 19602ac6454SAndrew Thompson { 197760bc48eSAndrew Thompson struct usb_attach_arg *uaa = device_get_ivars(dev); 19802ac6454SAndrew Thompson struct uark_softc *sc = device_get_softc(dev); 19902ac6454SAndrew Thompson int32_t error; 20002ac6454SAndrew Thompson uint8_t iface_index; 20102ac6454SAndrew Thompson 202a593f6b8SAndrew Thompson device_set_usb_desc(dev); 203deefe583SAndrew Thompson mtx_init(&sc->sc_mtx, "uark", NULL, MTX_DEF); 20402ac6454SAndrew Thompson 20502ac6454SAndrew Thompson sc->sc_udev = uaa->device; 20602ac6454SAndrew Thompson 20702ac6454SAndrew Thompson iface_index = UARK_IFACE_INDEX; 208a593f6b8SAndrew Thompson error = usbd_transfer_setup 20902ac6454SAndrew Thompson (uaa->device, &iface_index, sc->sc_xfer, 210deefe583SAndrew Thompson uark_xfer_config, UARK_N_TRANSFER, sc, &sc->sc_mtx); 21102ac6454SAndrew Thompson 21202ac6454SAndrew Thompson if (error) { 21302ac6454SAndrew Thompson device_printf(dev, "allocating control USB " 21402ac6454SAndrew Thompson "transfers failed!\n"); 21502ac6454SAndrew Thompson goto detach; 21602ac6454SAndrew Thompson } 21702ac6454SAndrew Thompson /* clear stall at first run */ 218deefe583SAndrew Thompson mtx_lock(&sc->sc_mtx); 219ed6d949aSAndrew Thompson usbd_xfer_set_stall(sc->sc_xfer[UARK_BULK_DT_WR]); 220ed6d949aSAndrew Thompson usbd_xfer_set_stall(sc->sc_xfer[UARK_BULK_DT_RD]); 221deefe583SAndrew Thompson mtx_unlock(&sc->sc_mtx); 22202ac6454SAndrew Thompson 223a593f6b8SAndrew Thompson error = ucom_attach(&sc->sc_super_ucom, &sc->sc_ucom, 1, sc, 224deefe583SAndrew Thompson &uark_callback, &sc->sc_mtx); 22502ac6454SAndrew Thompson if (error) { 226a593f6b8SAndrew Thompson DPRINTF("ucom_attach failed\n"); 22702ac6454SAndrew Thompson goto detach; 22802ac6454SAndrew Thompson } 22902ac6454SAndrew Thompson return (0); /* success */ 23002ac6454SAndrew Thompson 23102ac6454SAndrew Thompson detach: 23202ac6454SAndrew Thompson uark_detach(dev); 23302ac6454SAndrew Thompson return (ENXIO); /* failure */ 23402ac6454SAndrew Thompson } 23502ac6454SAndrew Thompson 23602ac6454SAndrew Thompson static int 23702ac6454SAndrew Thompson uark_detach(device_t dev) 23802ac6454SAndrew Thompson { 23902ac6454SAndrew Thompson struct uark_softc *sc = device_get_softc(dev); 24002ac6454SAndrew Thompson 241a593f6b8SAndrew Thompson ucom_detach(&sc->sc_super_ucom, &sc->sc_ucom, 1); 242a593f6b8SAndrew Thompson usbd_transfer_unsetup(sc->sc_xfer, UARK_N_TRANSFER); 243deefe583SAndrew Thompson mtx_destroy(&sc->sc_mtx); 24402ac6454SAndrew Thompson 24502ac6454SAndrew Thompson return (0); 24602ac6454SAndrew Thompson } 24702ac6454SAndrew Thompson 24802ac6454SAndrew Thompson static void 249ed6d949aSAndrew Thompson uark_bulk_write_callback(struct usb_xfer *xfer, usb_error_t error) 25002ac6454SAndrew Thompson { 251ed6d949aSAndrew Thompson struct uark_softc *sc = usbd_xfer_softc(xfer); 252ed6d949aSAndrew Thompson struct usb_page_cache *pc; 25302ac6454SAndrew Thompson uint32_t actlen; 25402ac6454SAndrew Thompson 25502ac6454SAndrew Thompson switch (USB_GET_STATE(xfer)) { 25602ac6454SAndrew Thompson case USB_ST_SETUP: 25702ac6454SAndrew Thompson case USB_ST_TRANSFERRED: 25802ac6454SAndrew Thompson tr_setup: 259ed6d949aSAndrew Thompson pc = usbd_xfer_get_frame(xfer, 0); 260ed6d949aSAndrew Thompson if (ucom_get_data(&sc->sc_ucom, pc, 0, 26102ac6454SAndrew Thompson UARK_BUF_SIZE, &actlen)) { 262ed6d949aSAndrew Thompson usbd_xfer_set_frame_len(xfer, 0, actlen); 263a593f6b8SAndrew Thompson usbd_transfer_submit(xfer); 26402ac6454SAndrew Thompson } 26502ac6454SAndrew Thompson return; 26602ac6454SAndrew Thompson 26702ac6454SAndrew Thompson default: /* Error */ 268ed6d949aSAndrew Thompson if (error != USB_ERR_CANCELLED) { 26902ac6454SAndrew Thompson /* try to clear stall first */ 270ed6d949aSAndrew Thompson usbd_xfer_set_stall(xfer); 27102ac6454SAndrew Thompson goto tr_setup; 27202ac6454SAndrew Thompson } 27302ac6454SAndrew Thompson return; 27402ac6454SAndrew Thompson 27502ac6454SAndrew Thompson } 27602ac6454SAndrew Thompson } 27702ac6454SAndrew Thompson 27802ac6454SAndrew Thompson static void 279ed6d949aSAndrew Thompson uark_bulk_read_callback(struct usb_xfer *xfer, usb_error_t error) 28002ac6454SAndrew Thompson { 281ed6d949aSAndrew Thompson struct uark_softc *sc = usbd_xfer_softc(xfer); 282ed6d949aSAndrew Thompson struct usb_page_cache *pc; 283ed6d949aSAndrew Thompson int actlen; 284ed6d949aSAndrew Thompson 285ed6d949aSAndrew Thompson usbd_xfer_status(xfer, &actlen, NULL, NULL, NULL); 28602ac6454SAndrew Thompson 28702ac6454SAndrew Thompson switch (USB_GET_STATE(xfer)) { 28802ac6454SAndrew Thompson case USB_ST_TRANSFERRED: 289ed6d949aSAndrew Thompson pc = usbd_xfer_get_frame(xfer, 0); 290ed6d949aSAndrew Thompson ucom_put_data(&sc->sc_ucom, pc, 0, actlen); 29102ac6454SAndrew Thompson 29202ac6454SAndrew Thompson case USB_ST_SETUP: 29302ac6454SAndrew Thompson tr_setup: 294ed6d949aSAndrew Thompson usbd_xfer_set_frame_len(xfer, 0, usbd_xfer_max_len(xfer)); 295a593f6b8SAndrew Thompson usbd_transfer_submit(xfer); 29602ac6454SAndrew Thompson return; 29702ac6454SAndrew Thompson 29802ac6454SAndrew Thompson default: /* Error */ 299ed6d949aSAndrew Thompson if (error != USB_ERR_CANCELLED) { 30002ac6454SAndrew Thompson /* try to clear stall first */ 301ed6d949aSAndrew Thompson usbd_xfer_set_stall(xfer); 30202ac6454SAndrew Thompson goto tr_setup; 30302ac6454SAndrew Thompson } 30402ac6454SAndrew Thompson return; 30502ac6454SAndrew Thompson } 30602ac6454SAndrew Thompson } 30702ac6454SAndrew Thompson 30802ac6454SAndrew Thompson static void 309760bc48eSAndrew Thompson uark_start_read(struct ucom_softc *ucom) 31002ac6454SAndrew Thompson { 31102ac6454SAndrew Thompson struct uark_softc *sc = ucom->sc_parent; 31202ac6454SAndrew Thompson 313a593f6b8SAndrew Thompson usbd_transfer_start(sc->sc_xfer[UARK_BULK_DT_RD]); 31402ac6454SAndrew Thompson } 31502ac6454SAndrew Thompson 31602ac6454SAndrew Thompson static void 317760bc48eSAndrew Thompson uark_stop_read(struct ucom_softc *ucom) 31802ac6454SAndrew Thompson { 31902ac6454SAndrew Thompson struct uark_softc *sc = ucom->sc_parent; 32002ac6454SAndrew Thompson 321a593f6b8SAndrew Thompson usbd_transfer_stop(sc->sc_xfer[UARK_BULK_DT_RD]); 32202ac6454SAndrew Thompson } 32302ac6454SAndrew Thompson 32402ac6454SAndrew Thompson static void 325760bc48eSAndrew Thompson uark_start_write(struct ucom_softc *ucom) 32602ac6454SAndrew Thompson { 32702ac6454SAndrew Thompson struct uark_softc *sc = ucom->sc_parent; 32802ac6454SAndrew Thompson 329a593f6b8SAndrew Thompson usbd_transfer_start(sc->sc_xfer[UARK_BULK_DT_WR]); 33002ac6454SAndrew Thompson } 33102ac6454SAndrew Thompson 33202ac6454SAndrew Thompson static void 333760bc48eSAndrew Thompson uark_stop_write(struct ucom_softc *ucom) 33402ac6454SAndrew Thompson { 33502ac6454SAndrew Thompson struct uark_softc *sc = ucom->sc_parent; 33602ac6454SAndrew Thompson 337a593f6b8SAndrew Thompson usbd_transfer_stop(sc->sc_xfer[UARK_BULK_DT_WR]); 33802ac6454SAndrew Thompson } 33902ac6454SAndrew Thompson 34002ac6454SAndrew Thompson static int 341760bc48eSAndrew Thompson uark_pre_param(struct ucom_softc *ucom, struct termios *t) 34202ac6454SAndrew Thompson { 34302ac6454SAndrew Thompson if ((t->c_ospeed < 300) || (t->c_ospeed > 115200)) 34402ac6454SAndrew Thompson return (EINVAL); 34502ac6454SAndrew Thompson return (0); 34602ac6454SAndrew Thompson } 34702ac6454SAndrew Thompson 34802ac6454SAndrew Thompson static void 349760bc48eSAndrew Thompson uark_cfg_param(struct ucom_softc *ucom, struct termios *t) 35002ac6454SAndrew Thompson { 35102ac6454SAndrew Thompson struct uark_softc *sc = ucom->sc_parent; 35202ac6454SAndrew Thompson uint32_t speed = t->c_ospeed; 35302ac6454SAndrew Thompson uint16_t data; 35402ac6454SAndrew Thompson 35502ac6454SAndrew Thompson /* 35602ac6454SAndrew Thompson * NOTE: When reverse computing the baud rate from the "data" all 35702ac6454SAndrew Thompson * allowed baud rates are within 3% of the initial baud rate. 35802ac6454SAndrew Thompson */ 35902ac6454SAndrew Thompson data = (UARK_BAUD_REF + (speed / 2)) / speed; 36002ac6454SAndrew Thompson 36102ac6454SAndrew Thompson uark_cfg_write(sc, 3, 0x83); 36202ac6454SAndrew Thompson uark_cfg_write(sc, 0, data & 0xFF); 36302ac6454SAndrew Thompson uark_cfg_write(sc, 1, data >> 8); 36402ac6454SAndrew Thompson uark_cfg_write(sc, 3, 0x03); 36502ac6454SAndrew Thompson 36602ac6454SAndrew Thompson if (t->c_cflag & CSTOPB) 36702ac6454SAndrew Thompson data = UARK_STOP_BITS_2; 36802ac6454SAndrew Thompson else 36902ac6454SAndrew Thompson data = UARK_STOP_BITS_1; 37002ac6454SAndrew Thompson 37102ac6454SAndrew Thompson if (t->c_cflag & PARENB) { 37202ac6454SAndrew Thompson if (t->c_cflag & PARODD) 37302ac6454SAndrew Thompson data |= UARK_PARITY_ODD; 37402ac6454SAndrew Thompson else 37502ac6454SAndrew Thompson data |= UARK_PARITY_EVEN; 37602ac6454SAndrew Thompson } else 37702ac6454SAndrew Thompson data |= UARK_PARITY_NONE; 37802ac6454SAndrew Thompson 37902ac6454SAndrew Thompson switch (t->c_cflag & CSIZE) { 38002ac6454SAndrew Thompson case CS5: 38102ac6454SAndrew Thompson data |= UARK_SET_DATA_BITS(5); 38202ac6454SAndrew Thompson break; 38302ac6454SAndrew Thompson case CS6: 38402ac6454SAndrew Thompson data |= UARK_SET_DATA_BITS(6); 38502ac6454SAndrew Thompson break; 38602ac6454SAndrew Thompson case CS7: 38702ac6454SAndrew Thompson data |= UARK_SET_DATA_BITS(7); 38802ac6454SAndrew Thompson break; 38902ac6454SAndrew Thompson default: 39002ac6454SAndrew Thompson case CS8: 39102ac6454SAndrew Thompson data |= UARK_SET_DATA_BITS(8); 39202ac6454SAndrew Thompson break; 39302ac6454SAndrew Thompson } 39402ac6454SAndrew Thompson uark_cfg_write(sc, 3, 0x00); 39502ac6454SAndrew Thompson uark_cfg_write(sc, 3, data); 39602ac6454SAndrew Thompson } 39702ac6454SAndrew Thompson 39802ac6454SAndrew Thompson static void 399760bc48eSAndrew Thompson uark_cfg_get_status(struct ucom_softc *ucom, uint8_t *lsr, uint8_t *msr) 40002ac6454SAndrew Thompson { 40102ac6454SAndrew Thompson struct uark_softc *sc = ucom->sc_parent; 40202ac6454SAndrew Thompson 40302ac6454SAndrew Thompson *lsr = sc->sc_lsr; 40402ac6454SAndrew Thompson *msr = sc->sc_msr; 40502ac6454SAndrew Thompson } 40602ac6454SAndrew Thompson 40702ac6454SAndrew Thompson static void 408760bc48eSAndrew Thompson uark_cfg_set_break(struct ucom_softc *ucom, uint8_t onoff) 40902ac6454SAndrew Thompson { 41002ac6454SAndrew Thompson struct uark_softc *sc = ucom->sc_parent; 41102ac6454SAndrew Thompson 41202ac6454SAndrew Thompson DPRINTF("onoff=%d\n", onoff); 41302ac6454SAndrew Thompson 41402ac6454SAndrew Thompson uark_cfg_write(sc, 4, onoff ? 0x01 : 0x00); 41502ac6454SAndrew Thompson } 41602ac6454SAndrew Thompson 41702ac6454SAndrew Thompson static void 41802ac6454SAndrew Thompson uark_cfg_write(struct uark_softc *sc, uint16_t index, uint16_t value) 41902ac6454SAndrew Thompson { 420760bc48eSAndrew Thompson struct usb_device_request req; 421e0a69b51SAndrew Thompson usb_error_t err; 42202ac6454SAndrew Thompson 42302ac6454SAndrew Thompson req.bmRequestType = UARK_WRITE; 42402ac6454SAndrew Thompson req.bRequest = UARK_REQUEST; 42502ac6454SAndrew Thompson USETW(req.wValue, value); 42602ac6454SAndrew Thompson USETW(req.wIndex, index); 42702ac6454SAndrew Thompson USETW(req.wLength, 0); 42802ac6454SAndrew Thompson 429a593f6b8SAndrew Thompson err = ucom_cfg_do_request(sc->sc_udev, &sc->sc_ucom, 43002ac6454SAndrew Thompson &req, NULL, 0, 1000); 43102ac6454SAndrew Thompson if (err) { 43202ac6454SAndrew Thompson DPRINTFN(0, "device request failed, err=%s " 433a593f6b8SAndrew Thompson "(ignored)\n", usbd_errstr(err)); 43402ac6454SAndrew Thompson } 43502ac6454SAndrew Thompson } 436655dc9d0SAndrew Thompson 437655dc9d0SAndrew Thompson static void 438655dc9d0SAndrew Thompson uark_poll(struct ucom_softc *ucom) 439655dc9d0SAndrew Thompson { 440655dc9d0SAndrew Thompson struct uark_softc *sc = ucom->sc_parent; 441655dc9d0SAndrew Thompson usbd_transfer_poll(sc->sc_xfer, UARK_N_TRANSFER); 442655dc9d0SAndrew Thompson } 443