urio.c revision 276701
1184610Salfred/*- 2184610Salfred * Copyright (c) 2000 Iwasa Kazmi 3184610Salfred * All rights reserved. 4184610Salfred * 5184610Salfred * Redistribution and use in source and binary forms, with or without 6184610Salfred * modification, are permitted provided that the following conditions 7184610Salfred * are met: 8184610Salfred * 1. Redistributions of source code must retain the above copyright 9184610Salfred * notice, this list of conditions, and the following disclaimer. 10184610Salfred * 2. Redistributions in binary form must reproduce the above copyright 11184610Salfred * notice, this list of conditions and the following disclaimer in the 12184610Salfred * documentation and/or other materials provided with the distribution. 13184610Salfred * 14184610Salfred * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND 15184610Salfred * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 16184610Salfred * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 17184610Salfred * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE FOR 18184610Salfred * ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 19184610Salfred * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 20184610Salfred * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 21184610Salfred * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 22184610Salfred * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 23184610Salfred * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 24184610Salfred * SUCH DAMAGE. 25184610Salfred * 26184610Salfred * This code is based on ugen.c and ulpt.c developed by Lennart Augustsson. 27184610Salfred * This code includes software developed by the NetBSD Foundation, Inc. and 28184610Salfred * its contributors. 29184610Salfred */ 30184610Salfred 31184610Salfred#include <sys/cdefs.h> 32184610Salfred__FBSDID("$FreeBSD: head/sys/dev/usb/storage/urio.c 276701 2015-01-05 15:04:17Z hselasky $"); 33184610Salfred 34184610Salfred 35184610Salfred/* 36184610Salfred * 2000/3/24 added NetBSD/OpenBSD support (from Alex Nemirovsky) 37184610Salfred * 2000/3/07 use two bulk-pipe handles for read and write (Dirk) 38184610Salfred * 2000/3/06 change major number(143), and copyright header 39184610Salfred * some fix for 4.0 (Dirk) 40184610Salfred * 2000/3/05 codes for FreeBSD 4.x - CURRENT (Thanks to Dirk-Willem van Gulik) 41184610Salfred * 2000/3/01 remove retry code from urioioctl() 42184610Salfred * change method of bulk transfer (no interrupt) 43184610Salfred * 2000/2/28 small fixes for new rio_usb.h 44184610Salfred * 2000/2/24 first version. 45184610Salfred */ 46184610Salfred 47194677Sthompsa#include <sys/stdint.h> 48194677Sthompsa#include <sys/stddef.h> 49194677Sthompsa#include <sys/param.h> 50194677Sthompsa#include <sys/queue.h> 51194677Sthompsa#include <sys/types.h> 52194677Sthompsa#include <sys/systm.h> 53194677Sthompsa#include <sys/kernel.h> 54194677Sthompsa#include <sys/bus.h> 55194677Sthompsa#include <sys/module.h> 56194677Sthompsa#include <sys/lock.h> 57194677Sthompsa#include <sys/mutex.h> 58194677Sthompsa#include <sys/condvar.h> 59194677Sthompsa#include <sys/sysctl.h> 60194677Sthompsa#include <sys/sx.h> 61194677Sthompsa#include <sys/unistd.h> 62194677Sthompsa#include <sys/callout.h> 63194677Sthompsa#include <sys/malloc.h> 64194677Sthompsa#include <sys/priv.h> 65194677Sthompsa#include <sys/conf.h> 66194677Sthompsa#include <sys/fcntl.h> 67194677Sthompsa 68194677Sthompsa#include <dev/usb/usb.h> 69194677Sthompsa#include <dev/usb/usbdi.h> 70188746Sthompsa#include "usbdevs.h" 71194677Sthompsa 72188942Sthompsa#include <dev/usb/usb_ioctl.h> 73194677Sthompsa#include <dev/usb/usb_generic.h> 74184610Salfred 75184610Salfred#define USB_DEBUG_VAR urio_debug 76188942Sthompsa#include <dev/usb/usb_debug.h> 77184610Salfred 78194677Sthompsa#include <dev/usb/storage/rio500_usb.h> 79194677Sthompsa 80207077Sthompsa#ifdef USB_DEBUG 81184610Salfredstatic int urio_debug = 0; 82184610Salfred 83227309Sedstatic SYSCTL_NODE(_hw_usb, OID_AUTO, urio, CTLFLAG_RW, 0, "USB urio"); 84276701ShselaskySYSCTL_INT(_hw_usb_urio, OID_AUTO, debug, CTLFLAG_RWTUN, 85184610Salfred &urio_debug, 0, "urio debug level"); 86184610Salfred#endif 87184610Salfred 88184610Salfred#define URIO_T_WR 0 89184610Salfred#define URIO_T_RD 1 90184610Salfred#define URIO_T_WR_CS 2 91184610Salfred#define URIO_T_RD_CS 3 92184610Salfred#define URIO_T_MAX 4 93184610Salfred 94184610Salfred#define URIO_BSIZE (1<<12) /* bytes */ 95184610Salfred#define URIO_IFQ_MAXLEN 2 /* units */ 96184610Salfred 97184610Salfredstruct urio_softc { 98192984Sthompsa struct usb_fifo_sc sc_fifo; 99184610Salfred struct mtx sc_mtx; 100184610Salfred 101192984Sthompsa struct usb_device *sc_udev; 102192984Sthompsa struct usb_xfer *sc_xfer[URIO_T_MAX]; 103184610Salfred 104184610Salfred uint8_t sc_flags; 105184610Salfred#define URIO_FLAG_READ_STALL 0x01 /* read transfer stalled */ 106184610Salfred#define URIO_FLAG_WRITE_STALL 0x02 /* write transfer stalled */ 107184610Salfred 108184610Salfred uint8_t sc_name[16]; 109184610Salfred}; 110184610Salfred 111184610Salfred/* prototypes */ 112184610Salfred 113184610Salfredstatic device_probe_t urio_probe; 114184610Salfredstatic device_attach_t urio_attach; 115184610Salfredstatic device_detach_t urio_detach; 116184610Salfred 117193045Sthompsastatic usb_callback_t urio_write_callback; 118193045Sthompsastatic usb_callback_t urio_write_clear_stall_callback; 119193045Sthompsastatic usb_callback_t urio_read_callback; 120193045Sthompsastatic usb_callback_t urio_read_clear_stall_callback; 121184610Salfred 122193045Sthompsastatic usb_fifo_close_t urio_close; 123193045Sthompsastatic usb_fifo_cmd_t urio_start_read; 124193045Sthompsastatic usb_fifo_cmd_t urio_start_write; 125193045Sthompsastatic usb_fifo_cmd_t urio_stop_read; 126193045Sthompsastatic usb_fifo_cmd_t urio_stop_write; 127193045Sthompsastatic usb_fifo_ioctl_t urio_ioctl; 128193045Sthompsastatic usb_fifo_open_t urio_open; 129184610Salfred 130192984Sthompsastatic struct usb_fifo_methods urio_fifo_methods = { 131184610Salfred .f_close = &urio_close, 132184610Salfred .f_ioctl = &urio_ioctl, 133184610Salfred .f_open = &urio_open, 134184610Salfred .f_start_read = &urio_start_read, 135184610Salfred .f_start_write = &urio_start_write, 136184610Salfred .f_stop_read = &urio_stop_read, 137184610Salfred .f_stop_write = &urio_stop_write, 138184610Salfred .basename[0] = "urio", 139184610Salfred}; 140184610Salfred 141192984Sthompsastatic const struct usb_config urio_config[URIO_T_MAX] = { 142184610Salfred [URIO_T_WR] = { 143184610Salfred .type = UE_BULK, 144184610Salfred .endpoint = UE_ADDR_ANY, 145184610Salfred .direction = UE_DIR_OUT, 146190734Sthompsa .bufsize = URIO_BSIZE, 147190734Sthompsa .flags = {.pipe_bof = 1,.force_short_xfer = 1,.proxy_buffer = 1,}, 148190734Sthompsa .callback = &urio_write_callback, 149184610Salfred }, 150184610Salfred 151184610Salfred [URIO_T_RD] = { 152184610Salfred .type = UE_BULK, 153184610Salfred .endpoint = UE_ADDR_ANY, 154184610Salfred .direction = UE_DIR_IN, 155190734Sthompsa .bufsize = URIO_BSIZE, 156190734Sthompsa .flags = {.pipe_bof = 1,.short_xfer_ok = 1,.proxy_buffer = 1,}, 157190734Sthompsa .callback = &urio_read_callback, 158184610Salfred }, 159184610Salfred 160184610Salfred [URIO_T_WR_CS] = { 161184610Salfred .type = UE_CONTROL, 162184610Salfred .endpoint = 0x00, /* Control pipe */ 163184610Salfred .direction = UE_DIR_ANY, 164192984Sthompsa .bufsize = sizeof(struct usb_device_request), 165190734Sthompsa .callback = &urio_write_clear_stall_callback, 166190734Sthompsa .timeout = 1000, /* 1 second */ 167190734Sthompsa .interval = 50, /* 50ms */ 168184610Salfred }, 169184610Salfred 170184610Salfred [URIO_T_RD_CS] = { 171184610Salfred .type = UE_CONTROL, 172184610Salfred .endpoint = 0x00, /* Control pipe */ 173184610Salfred .direction = UE_DIR_ANY, 174192984Sthompsa .bufsize = sizeof(struct usb_device_request), 175190734Sthompsa .callback = &urio_read_clear_stall_callback, 176190734Sthompsa .timeout = 1000, /* 1 second */ 177190734Sthompsa .interval = 50, /* 50ms */ 178184610Salfred }, 179184610Salfred}; 180184610Salfred 181184610Salfredstatic devclass_t urio_devclass; 182184610Salfred 183184610Salfredstatic device_method_t urio_methods[] = { 184184610Salfred /* Device interface */ 185184610Salfred DEVMETHOD(device_probe, urio_probe), 186184610Salfred DEVMETHOD(device_attach, urio_attach), 187184610Salfred DEVMETHOD(device_detach, urio_detach), 188246128Ssbz 189246128Ssbz DEVMETHOD_END 190184610Salfred}; 191184610Salfred 192184610Salfredstatic driver_t urio_driver = { 193184610Salfred .name = "urio", 194184610Salfred .methods = urio_methods, 195184610Salfred .size = sizeof(struct urio_softc), 196184610Salfred}; 197184610Salfred 198189275SthompsaDRIVER_MODULE(urio, uhub, urio_driver, urio_devclass, NULL, 0); 199188942SthompsaMODULE_DEPEND(urio, usb, 1, 1, 1); 200212122SthompsaMODULE_VERSION(urio, 1); 201184610Salfred 202223511Shselaskystatic const STRUCT_USB_HOST_ID urio_devs[] = { 203223511Shselasky {USB_VPI(USB_VENDOR_DIAMOND, USB_PRODUCT_DIAMOND_RIO500USB, 0)}, 204223511Shselasky {USB_VPI(USB_VENDOR_DIAMOND2, USB_PRODUCT_DIAMOND2_RIO600USB, 0)}, 205223511Shselasky {USB_VPI(USB_VENDOR_DIAMOND2, USB_PRODUCT_DIAMOND2_RIO800USB, 0)}, 206223511Shselasky}; 207223511Shselasky 208184610Salfredstatic int 209184610Salfredurio_probe(device_t dev) 210184610Salfred{ 211192984Sthompsa struct usb_attach_arg *uaa = device_get_ivars(dev); 212184610Salfred 213223511Shselasky if (uaa->usb_mode != USB_MODE_HOST) 214184610Salfred return (ENXIO); 215223511Shselasky if (uaa->info.bConfigIndex != 0) 216184610Salfred return (ENXIO); 217223511Shselasky if (uaa->info.bIfaceIndex != 0) 218223511Shselasky return (ENXIO); 219223511Shselasky 220223511Shselasky return (usbd_lookup_id_by_uaa(urio_devs, sizeof(urio_devs), uaa)); 221184610Salfred} 222184610Salfred 223184610Salfredstatic int 224184610Salfredurio_attach(device_t dev) 225184610Salfred{ 226192984Sthompsa struct usb_attach_arg *uaa = device_get_ivars(dev); 227184610Salfred struct urio_softc *sc = device_get_softc(dev); 228184610Salfred int error; 229184610Salfred 230194228Sthompsa device_set_usb_desc(dev); 231184610Salfred 232184610Salfred sc->sc_udev = uaa->device; 233184610Salfred 234184610Salfred mtx_init(&sc->sc_mtx, "urio lock", NULL, MTX_DEF | MTX_RECURSE); 235184610Salfred 236184610Salfred snprintf(sc->sc_name, sizeof(sc->sc_name), 237184610Salfred "%s", device_get_nameunit(dev)); 238184610Salfred 239194228Sthompsa error = usbd_transfer_setup(uaa->device, 240184610Salfred &uaa->info.bIfaceIndex, sc->sc_xfer, 241184610Salfred urio_config, URIO_T_MAX, sc, &sc->sc_mtx); 242184610Salfred 243184610Salfred if (error) { 244194228Sthompsa DPRINTF("error=%s\n", usbd_errstr(error)); 245184610Salfred goto detach; 246184610Salfred } 247184610Salfred 248194228Sthompsa error = usb_fifo_attach(uaa->device, sc, &sc->sc_mtx, 249184610Salfred &urio_fifo_methods, &sc->sc_fifo, 250233774Shselasky device_get_unit(dev), -1, uaa->info.bIfaceIndex, 251189110Sthompsa UID_ROOT, GID_OPERATOR, 0644); 252184610Salfred if (error) { 253184610Salfred goto detach; 254184610Salfred } 255184610Salfred return (0); /* success */ 256184610Salfred 257184610Salfreddetach: 258184610Salfred urio_detach(dev); 259184610Salfred return (ENOMEM); /* failure */ 260184610Salfred} 261184610Salfred 262184610Salfredstatic void 263194677Sthompsaurio_write_callback(struct usb_xfer *xfer, usb_error_t error) 264184610Salfred{ 265194677Sthompsa struct urio_softc *sc = usbd_xfer_softc(xfer); 266192984Sthompsa struct usb_fifo *f = sc->sc_fifo.fp[USB_FIFO_TX]; 267194677Sthompsa struct usb_page_cache *pc; 268184610Salfred uint32_t actlen; 269184610Salfred 270184610Salfred switch (USB_GET_STATE(xfer)) { 271184610Salfred case USB_ST_TRANSFERRED: 272184610Salfred case USB_ST_SETUP: 273184610Salfred if (sc->sc_flags & URIO_FLAG_WRITE_STALL) { 274194228Sthompsa usbd_transfer_start(sc->sc_xfer[URIO_T_WR_CS]); 275184610Salfred return; 276184610Salfred } 277194677Sthompsa pc = usbd_xfer_get_frame(xfer, 0); 278194677Sthompsa if (usb_fifo_get_data(f, pc, 0, 279194677Sthompsa usbd_xfer_max_len(xfer), &actlen, 0)) { 280184610Salfred 281194677Sthompsa usbd_xfer_set_frame_len(xfer, 0, actlen); 282194228Sthompsa usbd_transfer_submit(xfer); 283184610Salfred } 284184610Salfred return; 285184610Salfred 286184610Salfred default: /* Error */ 287194677Sthompsa if (error != USB_ERR_CANCELLED) { 288184610Salfred /* try to clear stall first */ 289184610Salfred sc->sc_flags |= URIO_FLAG_WRITE_STALL; 290194228Sthompsa usbd_transfer_start(sc->sc_xfer[URIO_T_WR_CS]); 291184610Salfred } 292184610Salfred return; 293184610Salfred } 294184610Salfred} 295184610Salfred 296184610Salfredstatic void 297194677Sthompsaurio_write_clear_stall_callback(struct usb_xfer *xfer, usb_error_t error) 298184610Salfred{ 299194677Sthompsa struct urio_softc *sc = usbd_xfer_softc(xfer); 300192984Sthompsa struct usb_xfer *xfer_other = sc->sc_xfer[URIO_T_WR]; 301184610Salfred 302194228Sthompsa if (usbd_clear_stall_callback(xfer, xfer_other)) { 303184610Salfred DPRINTF("stall cleared\n"); 304184610Salfred sc->sc_flags &= ~URIO_FLAG_WRITE_STALL; 305194228Sthompsa usbd_transfer_start(xfer_other); 306184610Salfred } 307184610Salfred} 308184610Salfred 309184610Salfredstatic void 310194677Sthompsaurio_read_callback(struct usb_xfer *xfer, usb_error_t error) 311184610Salfred{ 312194677Sthompsa struct urio_softc *sc = usbd_xfer_softc(xfer); 313192984Sthompsa struct usb_fifo *f = sc->sc_fifo.fp[USB_FIFO_RX]; 314194677Sthompsa struct usb_page_cache *pc; 315194677Sthompsa int actlen; 316184610Salfred 317194677Sthompsa usbd_xfer_status(xfer, &actlen, NULL, NULL, NULL); 318194677Sthompsa 319184610Salfred switch (USB_GET_STATE(xfer)) { 320184610Salfred case USB_ST_TRANSFERRED: 321194677Sthompsa pc = usbd_xfer_get_frame(xfer, 0); 322194677Sthompsa usb_fifo_put_data(f, pc, 0, actlen, 1); 323184610Salfred 324184610Salfred case USB_ST_SETUP: 325184610Salfred if (sc->sc_flags & URIO_FLAG_READ_STALL) { 326194228Sthompsa usbd_transfer_start(sc->sc_xfer[URIO_T_RD_CS]); 327184610Salfred return; 328184610Salfred } 329194228Sthompsa if (usb_fifo_put_bytes_max(f) != 0) { 330194677Sthompsa usbd_xfer_set_frame_len(xfer, 0, usbd_xfer_max_len(xfer)); 331194228Sthompsa usbd_transfer_submit(xfer); 332184610Salfred } 333184610Salfred return; 334184610Salfred 335184610Salfred default: /* Error */ 336194677Sthompsa if (error != USB_ERR_CANCELLED) { 337184610Salfred /* try to clear stall first */ 338184610Salfred sc->sc_flags |= URIO_FLAG_READ_STALL; 339194228Sthompsa usbd_transfer_start(sc->sc_xfer[URIO_T_RD_CS]); 340184610Salfred } 341184610Salfred return; 342184610Salfred } 343184610Salfred} 344184610Salfred 345184610Salfredstatic void 346194677Sthompsaurio_read_clear_stall_callback(struct usb_xfer *xfer, usb_error_t error) 347184610Salfred{ 348194677Sthompsa struct urio_softc *sc = usbd_xfer_softc(xfer); 349192984Sthompsa struct usb_xfer *xfer_other = sc->sc_xfer[URIO_T_RD]; 350184610Salfred 351194228Sthompsa if (usbd_clear_stall_callback(xfer, xfer_other)) { 352184610Salfred DPRINTF("stall cleared\n"); 353184610Salfred sc->sc_flags &= ~URIO_FLAG_READ_STALL; 354194228Sthompsa usbd_transfer_start(xfer_other); 355184610Salfred } 356184610Salfred} 357184610Salfred 358184610Salfredstatic void 359192984Sthompsaurio_start_read(struct usb_fifo *fifo) 360184610Salfred{ 361194677Sthompsa struct urio_softc *sc = usb_fifo_softc(fifo); 362184610Salfred 363194228Sthompsa usbd_transfer_start(sc->sc_xfer[URIO_T_RD]); 364184610Salfred} 365184610Salfred 366184610Salfredstatic void 367192984Sthompsaurio_stop_read(struct usb_fifo *fifo) 368184610Salfred{ 369194677Sthompsa struct urio_softc *sc = usb_fifo_softc(fifo); 370184610Salfred 371194228Sthompsa usbd_transfer_stop(sc->sc_xfer[URIO_T_RD_CS]); 372194228Sthompsa usbd_transfer_stop(sc->sc_xfer[URIO_T_RD]); 373184610Salfred} 374184610Salfred 375184610Salfredstatic void 376192984Sthompsaurio_start_write(struct usb_fifo *fifo) 377184610Salfred{ 378194677Sthompsa struct urio_softc *sc = usb_fifo_softc(fifo); 379184610Salfred 380194228Sthompsa usbd_transfer_start(sc->sc_xfer[URIO_T_WR]); 381184610Salfred} 382184610Salfred 383184610Salfredstatic void 384192984Sthompsaurio_stop_write(struct usb_fifo *fifo) 385184610Salfred{ 386194677Sthompsa struct urio_softc *sc = usb_fifo_softc(fifo); 387184610Salfred 388194228Sthompsa usbd_transfer_stop(sc->sc_xfer[URIO_T_WR_CS]); 389194228Sthompsa usbd_transfer_stop(sc->sc_xfer[URIO_T_WR]); 390184610Salfred} 391184610Salfred 392184610Salfredstatic int 393192984Sthompsaurio_open(struct usb_fifo *fifo, int fflags) 394184610Salfred{ 395194677Sthompsa struct urio_softc *sc = usb_fifo_softc(fifo); 396184610Salfred 397184610Salfred if (fflags & FREAD) { 398184610Salfred /* clear stall first */ 399184610Salfred mtx_lock(&sc->sc_mtx); 400184610Salfred sc->sc_flags |= URIO_FLAG_READ_STALL; 401184610Salfred mtx_unlock(&sc->sc_mtx); 402184610Salfred 403194228Sthompsa if (usb_fifo_alloc_buffer(fifo, 404194677Sthompsa usbd_xfer_max_len(sc->sc_xfer[URIO_T_RD]), 405184610Salfred URIO_IFQ_MAXLEN)) { 406184610Salfred return (ENOMEM); 407184610Salfred } 408184610Salfred } 409184610Salfred if (fflags & FWRITE) { 410184610Salfred /* clear stall first */ 411184610Salfred sc->sc_flags |= URIO_FLAG_WRITE_STALL; 412184610Salfred 413194228Sthompsa if (usb_fifo_alloc_buffer(fifo, 414194677Sthompsa usbd_xfer_max_len(sc->sc_xfer[URIO_T_WR]), 415184610Salfred URIO_IFQ_MAXLEN)) { 416184610Salfred return (ENOMEM); 417184610Salfred } 418184610Salfred } 419184610Salfred return (0); /* success */ 420184610Salfred} 421184610Salfred 422184610Salfredstatic void 423192984Sthompsaurio_close(struct usb_fifo *fifo, int fflags) 424184610Salfred{ 425184610Salfred if (fflags & (FREAD | FWRITE)) { 426194228Sthompsa usb_fifo_free_buffer(fifo); 427184610Salfred } 428184610Salfred} 429184610Salfred 430184610Salfredstatic int 431192984Sthompsaurio_ioctl(struct usb_fifo *fifo, u_long cmd, void *addr, 432189110Sthompsa int fflags) 433184610Salfred{ 434192984Sthompsa struct usb_ctl_request ur; 435184610Salfred struct RioCommand *rio_cmd; 436184610Salfred int error; 437184610Salfred 438184610Salfred switch (cmd) { 439184610Salfred case RIO_RECV_COMMAND: 440184610Salfred if (!(fflags & FWRITE)) { 441184610Salfred error = EPERM; 442184610Salfred goto done; 443184610Salfred } 444227461Shselasky memset(&ur, 0, sizeof(ur)); 445184610Salfred rio_cmd = addr; 446184610Salfred ur.ucr_request.bmRequestType = 447184610Salfred rio_cmd->requesttype | UT_READ_VENDOR_DEVICE; 448184610Salfred break; 449184610Salfred 450184610Salfred case RIO_SEND_COMMAND: 451184610Salfred if (!(fflags & FWRITE)) { 452184610Salfred error = EPERM; 453184610Salfred goto done; 454184610Salfred } 455227461Shselasky memset(&ur, 0, sizeof(ur)); 456184610Salfred rio_cmd = addr; 457184610Salfred ur.ucr_request.bmRequestType = 458184610Salfred rio_cmd->requesttype | UT_WRITE_VENDOR_DEVICE; 459184610Salfred break; 460184610Salfred 461184610Salfred default: 462184610Salfred error = EINVAL; 463184610Salfred goto done; 464184610Salfred } 465184610Salfred 466184610Salfred DPRINTFN(2, "Sending command\n"); 467184610Salfred 468184610Salfred /* Send rio control message */ 469184610Salfred ur.ucr_request.bRequest = rio_cmd->request; 470184610Salfred USETW(ur.ucr_request.wValue, rio_cmd->value); 471184610Salfred USETW(ur.ucr_request.wIndex, rio_cmd->index); 472184610Salfred USETW(ur.ucr_request.wLength, rio_cmd->length); 473184610Salfred ur.ucr_data = rio_cmd->buffer; 474184610Salfred 475184610Salfred /* reuse generic USB code */ 476184610Salfred error = ugen_do_request(fifo, &ur); 477184610Salfred 478184610Salfreddone: 479184610Salfred return (error); 480184610Salfred} 481184610Salfred 482184610Salfredstatic int 483184610Salfredurio_detach(device_t dev) 484184610Salfred{ 485184610Salfred struct urio_softc *sc = device_get_softc(dev); 486184610Salfred 487184610Salfred DPRINTF("\n"); 488184610Salfred 489194228Sthompsa usb_fifo_detach(&sc->sc_fifo); 490184610Salfred 491194228Sthompsa usbd_transfer_unsetup(sc->sc_xfer, URIO_T_MAX); 492184610Salfred 493184610Salfred mtx_destroy(&sc->sc_mtx); 494184610Salfred 495184610Salfred return (0); 496184610Salfred} 497