1df4b8c2aSAndrew Thompson /* $FreeBSD$ */ 2df4b8c2aSAndrew Thompson /*- 35e53a4f9SPedro F. Giffuni * SPDX-License-Identifier: BSD-2-Clause-FreeBSD 45e53a4f9SPedro F. Giffuni * 5df4b8c2aSAndrew Thompson * Copyright (c) 2008 Hans Petter Selasky. All rights reserved. 6df4b8c2aSAndrew Thompson * 7df4b8c2aSAndrew Thompson * Redistribution and use in source and binary forms, with or without 8df4b8c2aSAndrew Thompson * modification, are permitted provided that the following conditions 9df4b8c2aSAndrew Thompson * are met: 10df4b8c2aSAndrew Thompson * 1. Redistributions of source code must retain the above copyright 11df4b8c2aSAndrew Thompson * notice, this list of conditions and the following disclaimer. 12df4b8c2aSAndrew Thompson * 2. Redistributions in binary form must reproduce the above copyright 13df4b8c2aSAndrew Thompson * notice, this list of conditions and the following disclaimer in the 14df4b8c2aSAndrew Thompson * documentation and/or other materials provided with the distribution. 15df4b8c2aSAndrew Thompson * 16df4b8c2aSAndrew Thompson * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND 17df4b8c2aSAndrew Thompson * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 18df4b8c2aSAndrew Thompson * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 19df4b8c2aSAndrew Thompson * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE 20df4b8c2aSAndrew Thompson * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 21df4b8c2aSAndrew Thompson * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 22df4b8c2aSAndrew Thompson * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 23df4b8c2aSAndrew Thompson * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 24df4b8c2aSAndrew Thompson * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 25df4b8c2aSAndrew Thompson * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 26df4b8c2aSAndrew Thompson * SUCH DAMAGE. 27df4b8c2aSAndrew Thompson */ 28df4b8c2aSAndrew Thompson 2966194130SHans Petter Selasky #ifdef LIBUSB_GLOBAL_INCLUDE_FILE 3066194130SHans Petter Selasky #include LIBUSB_GLOBAL_INCLUDE_FILE 3166194130SHans Petter Selasky #else 32f3cba95cSWojciech A. Koszek #include <errno.h> 33f3cba95cSWojciech A. Koszek #include <fcntl.h> 34df4b8c2aSAndrew Thompson #include <stdio.h> 35df4b8c2aSAndrew Thompson #include <stdlib.h> 36df4b8c2aSAndrew Thompson #include <string.h> 37f3cba95cSWojciech A. Koszek #include <unistd.h> 3866194130SHans Petter Selasky #include <time.h> 3966194130SHans Petter Selasky #include <sys/queue.h> 4066194130SHans Petter Selasky #include <sys/types.h> 4166194130SHans Petter Selasky #endif 42df4b8c2aSAndrew Thompson 43df4b8c2aSAndrew Thompson #include <dev/usb/usb.h> 44ed6d949aSAndrew Thompson #include <dev/usb/usbdi.h> 45df4b8c2aSAndrew Thompson #include <dev/usb/usb_ioctl.h> 46df4b8c2aSAndrew Thompson 4766194130SHans Petter Selasky #include "libusb20.h" 4866194130SHans Petter Selasky #include "libusb20_desc.h" 4966194130SHans Petter Selasky #include "libusb20_int.h" 5066194130SHans Petter Selasky 5199cd1f32SHans Petter Selasky #ifndef IOUSB 5299cd1f32SHans Petter Selasky #define IOUSB(a) a 5399cd1f32SHans Petter Selasky #endif 5499cd1f32SHans Petter Selasky 55df4b8c2aSAndrew Thompson static libusb20_init_backend_t ugen20_init_backend; 56df4b8c2aSAndrew Thompson static libusb20_open_device_t ugen20_open_device; 57df4b8c2aSAndrew Thompson static libusb20_close_device_t ugen20_close_device; 58df4b8c2aSAndrew Thompson static libusb20_get_backend_name_t ugen20_get_backend_name; 59df4b8c2aSAndrew Thompson static libusb20_exit_backend_t ugen20_exit_backend; 60df4b8c2aSAndrew Thompson static libusb20_dev_get_iface_desc_t ugen20_dev_get_iface_desc; 61df4b8c2aSAndrew Thompson static libusb20_dev_get_info_t ugen20_dev_get_info; 62df4b8c2aSAndrew Thompson static libusb20_root_get_dev_quirk_t ugen20_root_get_dev_quirk; 63df4b8c2aSAndrew Thompson static libusb20_root_get_quirk_name_t ugen20_root_get_quirk_name; 64df4b8c2aSAndrew Thompson static libusb20_root_add_dev_quirk_t ugen20_root_add_dev_quirk; 65df4b8c2aSAndrew Thompson static libusb20_root_remove_dev_quirk_t ugen20_root_remove_dev_quirk; 66df4b8c2aSAndrew Thompson static libusb20_root_set_template_t ugen20_root_set_template; 67df4b8c2aSAndrew Thompson static libusb20_root_get_template_t ugen20_root_get_template; 68df4b8c2aSAndrew Thompson 69df4b8c2aSAndrew Thompson const struct libusb20_backend_methods libusb20_ugen20_backend = { 70df4b8c2aSAndrew Thompson LIBUSB20_BACKEND(LIBUSB20_DECLARE, ugen20) 71df4b8c2aSAndrew Thompson }; 72df4b8c2aSAndrew Thompson 73df4b8c2aSAndrew Thompson /* USB device specific */ 74df4b8c2aSAndrew Thompson static libusb20_get_config_desc_full_t ugen20_get_config_desc_full; 75df4b8c2aSAndrew Thompson static libusb20_get_config_index_t ugen20_get_config_index; 76df4b8c2aSAndrew Thompson static libusb20_set_config_index_t ugen20_set_config_index; 77df4b8c2aSAndrew Thompson static libusb20_set_alt_index_t ugen20_set_alt_index; 78df4b8c2aSAndrew Thompson static libusb20_reset_device_t ugen20_reset_device; 79e50ac68bSAndrew Thompson static libusb20_check_connected_t ugen20_check_connected; 80df4b8c2aSAndrew Thompson static libusb20_set_power_mode_t ugen20_set_power_mode; 81df4b8c2aSAndrew Thompson static libusb20_get_power_mode_t ugen20_get_power_mode; 82aafcb732SHans Petter Selasky static libusb20_get_power_usage_t ugen20_get_power_usage; 83df4b8c2aSAndrew Thompson static libusb20_kernel_driver_active_t ugen20_kernel_driver_active; 84df4b8c2aSAndrew Thompson static libusb20_detach_kernel_driver_t ugen20_detach_kernel_driver; 85df4b8c2aSAndrew Thompson static libusb20_do_request_sync_t ugen20_do_request_sync; 86df4b8c2aSAndrew Thompson static libusb20_process_t ugen20_process; 87df4b8c2aSAndrew Thompson 88df4b8c2aSAndrew Thompson /* USB transfer specific */ 89df4b8c2aSAndrew Thompson static libusb20_tr_open_t ugen20_tr_open; 90df4b8c2aSAndrew Thompson static libusb20_tr_close_t ugen20_tr_close; 91df4b8c2aSAndrew Thompson static libusb20_tr_clear_stall_sync_t ugen20_tr_clear_stall_sync; 92df4b8c2aSAndrew Thompson static libusb20_tr_submit_t ugen20_tr_submit; 93df4b8c2aSAndrew Thompson static libusb20_tr_cancel_async_t ugen20_tr_cancel_async; 94df4b8c2aSAndrew Thompson 95df4b8c2aSAndrew Thompson static const struct libusb20_device_methods libusb20_ugen20_device_methods = { 96df4b8c2aSAndrew Thompson LIBUSB20_DEVICE(LIBUSB20_DECLARE, ugen20) 97df4b8c2aSAndrew Thompson }; 98df4b8c2aSAndrew Thompson 99df4b8c2aSAndrew Thompson static const char * 100df4b8c2aSAndrew Thompson ugen20_get_backend_name(void) 101df4b8c2aSAndrew Thompson { 102df4b8c2aSAndrew Thompson return ("FreeBSD UGEN 2.0"); 103df4b8c2aSAndrew Thompson } 104df4b8c2aSAndrew Thompson 105df4b8c2aSAndrew Thompson static uint32_t 106df4b8c2aSAndrew Thompson ugen20_path_convert_one(const char **pp) 107df4b8c2aSAndrew Thompson { 108df4b8c2aSAndrew Thompson const char *ptr; 109df4b8c2aSAndrew Thompson uint32_t temp = 0; 110df4b8c2aSAndrew Thompson 111df4b8c2aSAndrew Thompson ptr = *pp; 112df4b8c2aSAndrew Thompson 113df4b8c2aSAndrew Thompson while ((*ptr >= '0') && (*ptr <= '9')) { 114df4b8c2aSAndrew Thompson temp *= 10; 115df4b8c2aSAndrew Thompson temp += (*ptr - '0'); 116df4b8c2aSAndrew Thompson if (temp >= 1000000) { 117df4b8c2aSAndrew Thompson /* catch overflow early */ 118d81535d1SHans Petter Selasky return (0xFFFFFFFF); 119df4b8c2aSAndrew Thompson } 120df4b8c2aSAndrew Thompson ptr++; 121df4b8c2aSAndrew Thompson } 122df4b8c2aSAndrew Thompson 123df4b8c2aSAndrew Thompson if (*ptr == '.') { 124df4b8c2aSAndrew Thompson /* skip dot */ 125df4b8c2aSAndrew Thompson ptr++; 126df4b8c2aSAndrew Thompson } 127df4b8c2aSAndrew Thompson *pp = ptr; 128df4b8c2aSAndrew Thompson 129df4b8c2aSAndrew Thompson return (temp); 130df4b8c2aSAndrew Thompson } 131df4b8c2aSAndrew Thompson 132df4b8c2aSAndrew Thompson static int 133df4b8c2aSAndrew Thompson ugen20_enumerate(struct libusb20_device *pdev, const char *id) 134df4b8c2aSAndrew Thompson { 135df4b8c2aSAndrew Thompson const char *tmp = id; 136760bc48eSAndrew Thompson struct usb_device_descriptor ddesc; 137760bc48eSAndrew Thompson struct usb_device_info devinfo; 138*fd2ef04fSHans Petter Selasky struct usb_device_port_path udpp; 139df4b8c2aSAndrew Thompson uint32_t plugtime; 140df4b8c2aSAndrew Thompson char buf[64]; 141df4b8c2aSAndrew Thompson int f; 142df4b8c2aSAndrew Thompson int error; 143df4b8c2aSAndrew Thompson 144df4b8c2aSAndrew Thompson pdev->bus_number = ugen20_path_convert_one(&tmp); 145df4b8c2aSAndrew Thompson pdev->device_address = ugen20_path_convert_one(&tmp); 146df4b8c2aSAndrew Thompson 147df4b8c2aSAndrew Thompson snprintf(buf, sizeof(buf), "/dev/" USB_GENERIC_NAME "%u.%u", 148df4b8c2aSAndrew Thompson pdev->bus_number, pdev->device_address); 149df4b8c2aSAndrew Thompson 150df4b8c2aSAndrew Thompson f = open(buf, O_RDWR); 151df4b8c2aSAndrew Thompson if (f < 0) { 152df4b8c2aSAndrew Thompson return (LIBUSB20_ERROR_OTHER); 153df4b8c2aSAndrew Thompson } 15499cd1f32SHans Petter Selasky if (ioctl(f, IOUSB(USB_GET_PLUGTIME), &plugtime)) { 155df4b8c2aSAndrew Thompson error = LIBUSB20_ERROR_OTHER; 156df4b8c2aSAndrew Thompson goto done; 157df4b8c2aSAndrew Thompson } 158df4b8c2aSAndrew Thompson /* store when the device was plugged */ 159df4b8c2aSAndrew Thompson pdev->session_data.plugtime = plugtime; 160df4b8c2aSAndrew Thompson 16199cd1f32SHans Petter Selasky if (ioctl(f, IOUSB(USB_GET_DEVICE_DESC), &ddesc)) { 162df4b8c2aSAndrew Thompson error = LIBUSB20_ERROR_OTHER; 163df4b8c2aSAndrew Thompson goto done; 164df4b8c2aSAndrew Thompson } 165df4b8c2aSAndrew Thompson LIBUSB20_INIT(LIBUSB20_DEVICE_DESC, &(pdev->ddesc)); 166df4b8c2aSAndrew Thompson 167df4b8c2aSAndrew Thompson libusb20_me_decode(&ddesc, sizeof(ddesc), &(pdev->ddesc)); 168df4b8c2aSAndrew Thompson 169df4b8c2aSAndrew Thompson if (pdev->ddesc.bNumConfigurations == 0) { 170df4b8c2aSAndrew Thompson error = LIBUSB20_ERROR_OTHER; 171df4b8c2aSAndrew Thompson goto done; 172df4b8c2aSAndrew Thompson } else if (pdev->ddesc.bNumConfigurations >= 8) { 173df4b8c2aSAndrew Thompson error = LIBUSB20_ERROR_OTHER; 174df4b8c2aSAndrew Thompson goto done; 175df4b8c2aSAndrew Thompson } 17699cd1f32SHans Petter Selasky if (ioctl(f, IOUSB(USB_GET_DEVICEINFO), &devinfo)) { 177df4b8c2aSAndrew Thompson error = LIBUSB20_ERROR_OTHER; 178df4b8c2aSAndrew Thompson goto done; 179df4b8c2aSAndrew Thompson } 180df4b8c2aSAndrew Thompson switch (devinfo.udi_mode) { 181df4b8c2aSAndrew Thompson case USB_MODE_DEVICE: 182df4b8c2aSAndrew Thompson pdev->usb_mode = LIBUSB20_MODE_DEVICE; 183df4b8c2aSAndrew Thompson break; 184df4b8c2aSAndrew Thompson default: 185df4b8c2aSAndrew Thompson pdev->usb_mode = LIBUSB20_MODE_HOST; 186df4b8c2aSAndrew Thompson break; 187df4b8c2aSAndrew Thompson } 188df4b8c2aSAndrew Thompson 189df4b8c2aSAndrew Thompson switch (devinfo.udi_speed) { 190df4b8c2aSAndrew Thompson case USB_SPEED_LOW: 191df4b8c2aSAndrew Thompson pdev->usb_speed = LIBUSB20_SPEED_LOW; 192df4b8c2aSAndrew Thompson break; 193df4b8c2aSAndrew Thompson case USB_SPEED_FULL: 194df4b8c2aSAndrew Thompson pdev->usb_speed = LIBUSB20_SPEED_FULL; 195df4b8c2aSAndrew Thompson break; 196df4b8c2aSAndrew Thompson case USB_SPEED_HIGH: 197df4b8c2aSAndrew Thompson pdev->usb_speed = LIBUSB20_SPEED_HIGH; 198df4b8c2aSAndrew Thompson break; 199df4b8c2aSAndrew Thompson case USB_SPEED_VARIABLE: 200df4b8c2aSAndrew Thompson pdev->usb_speed = LIBUSB20_SPEED_VARIABLE; 201df4b8c2aSAndrew Thompson break; 202df4b8c2aSAndrew Thompson case USB_SPEED_SUPER: 203df4b8c2aSAndrew Thompson pdev->usb_speed = LIBUSB20_SPEED_SUPER; 204df4b8c2aSAndrew Thompson break; 205df4b8c2aSAndrew Thompson default: 206df4b8c2aSAndrew Thompson pdev->usb_speed = LIBUSB20_SPEED_UNKNOWN; 207df4b8c2aSAndrew Thompson break; 208df4b8c2aSAndrew Thompson } 209df4b8c2aSAndrew Thompson 2102485d8a7SHans Petter Selasky /* get parent HUB index and port */ 2112485d8a7SHans Petter Selasky 2122485d8a7SHans Petter Selasky pdev->parent_address = devinfo.udi_hubindex; 2132485d8a7SHans Petter Selasky pdev->parent_port = devinfo.udi_hubport; 2142485d8a7SHans Petter Selasky 215df4b8c2aSAndrew Thompson /* generate a nice description for printout */ 216df4b8c2aSAndrew Thompson 217df4b8c2aSAndrew Thompson snprintf(pdev->usb_desc, sizeof(pdev->usb_desc), 218df4b8c2aSAndrew Thompson USB_GENERIC_NAME "%u.%u: <%s %s> at usbus%u", pdev->bus_number, 2190b9cf972SEdward Tomasz Napierala pdev->device_address, devinfo.udi_vendor, 2200b9cf972SEdward Tomasz Napierala devinfo.udi_product, pdev->bus_number); 221df4b8c2aSAndrew Thompson 222*fd2ef04fSHans Petter Selasky /* get device port path, if any */ 223*fd2ef04fSHans Petter Selasky if (ioctl(f, IOUSB(USB_GET_DEV_PORT_PATH), &udpp) == 0 && 224*fd2ef04fSHans Petter Selasky udpp.udp_port_level < LIBUSB20_DEVICE_PORT_PATH_MAX) { 225*fd2ef04fSHans Petter Selasky memcpy(pdev->port_path, udpp.udp_port_no, udpp.udp_port_level); 226*fd2ef04fSHans Petter Selasky pdev->port_level = udpp.udp_port_level; 227*fd2ef04fSHans Petter Selasky } 228*fd2ef04fSHans Petter Selasky 229df4b8c2aSAndrew Thompson error = 0; 230df4b8c2aSAndrew Thompson done: 231df4b8c2aSAndrew Thompson close(f); 232df4b8c2aSAndrew Thompson return (error); 233df4b8c2aSAndrew Thompson } 234df4b8c2aSAndrew Thompson 235df4b8c2aSAndrew Thompson struct ugen20_urd_state { 236760bc48eSAndrew Thompson struct usb_read_dir urd; 237df4b8c2aSAndrew Thompson uint32_t nparsed; 238df4b8c2aSAndrew Thompson int f; 239df4b8c2aSAndrew Thompson uint8_t *ptr; 240df4b8c2aSAndrew Thompson const char *src; 241df4b8c2aSAndrew Thompson const char *dst; 242df4b8c2aSAndrew Thompson uint8_t buf[256]; 243df4b8c2aSAndrew Thompson uint8_t dummy_zero[1]; 244df4b8c2aSAndrew Thompson }; 245df4b8c2aSAndrew Thompson 246df4b8c2aSAndrew Thompson static int 247df4b8c2aSAndrew Thompson ugen20_readdir(struct ugen20_urd_state *st) 248df4b8c2aSAndrew Thompson { 249df4b8c2aSAndrew Thompson ; /* style fix */ 250df4b8c2aSAndrew Thompson repeat: 251df4b8c2aSAndrew Thompson if (st->ptr == NULL) { 252df4b8c2aSAndrew Thompson st->urd.urd_startentry += st->nparsed; 25351fd3d75SHans Petter Selasky st->urd.urd_data = libusb20_pass_ptr(st->buf); 254df4b8c2aSAndrew Thompson st->urd.urd_maxlen = sizeof(st->buf); 255df4b8c2aSAndrew Thompson st->nparsed = 0; 256df4b8c2aSAndrew Thompson 25799cd1f32SHans Petter Selasky if (ioctl(st->f, IOUSB(USB_READ_DIR), &st->urd)) { 258df4b8c2aSAndrew Thompson return (EINVAL); 259df4b8c2aSAndrew Thompson } 260df4b8c2aSAndrew Thompson st->ptr = st->buf; 261df4b8c2aSAndrew Thompson } 262df4b8c2aSAndrew Thompson if (st->ptr[0] == 0) { 263df4b8c2aSAndrew Thompson if (st->nparsed) { 264df4b8c2aSAndrew Thompson st->ptr = NULL; 265df4b8c2aSAndrew Thompson goto repeat; 266df4b8c2aSAndrew Thompson } else { 267df4b8c2aSAndrew Thompson return (ENXIO); 268df4b8c2aSAndrew Thompson } 269df4b8c2aSAndrew Thompson } 270df4b8c2aSAndrew Thompson st->src = (void *)(st->ptr + 1); 271df4b8c2aSAndrew Thompson st->dst = st->src + strlen(st->src) + 1; 272df4b8c2aSAndrew Thompson st->ptr = st->ptr + st->ptr[0]; 273df4b8c2aSAndrew Thompson st->nparsed++; 274df4b8c2aSAndrew Thompson 275df4b8c2aSAndrew Thompson if ((st->ptr < st->buf) || 276df4b8c2aSAndrew Thompson (st->ptr > st->dummy_zero)) { 277df4b8c2aSAndrew Thompson /* invalid entry */ 278df4b8c2aSAndrew Thompson return (EINVAL); 279df4b8c2aSAndrew Thompson } 280df4b8c2aSAndrew Thompson return (0); 281df4b8c2aSAndrew Thompson } 282df4b8c2aSAndrew Thompson 283df4b8c2aSAndrew Thompson static int 284df4b8c2aSAndrew Thompson ugen20_init_backend(struct libusb20_backend *pbe) 285df4b8c2aSAndrew Thompson { 286df4b8c2aSAndrew Thompson struct ugen20_urd_state state; 287df4b8c2aSAndrew Thompson struct libusb20_device *pdev; 288df4b8c2aSAndrew Thompson 289df4b8c2aSAndrew Thompson memset(&state, 0, sizeof(state)); 290df4b8c2aSAndrew Thompson 291df4b8c2aSAndrew Thompson state.f = open("/dev/" USB_DEVICE_NAME, O_RDONLY); 292df4b8c2aSAndrew Thompson if (state.f < 0) 293df4b8c2aSAndrew Thompson return (LIBUSB20_ERROR_OTHER); 294df4b8c2aSAndrew Thompson 295df4b8c2aSAndrew Thompson while (ugen20_readdir(&state) == 0) { 296df4b8c2aSAndrew Thompson 297df4b8c2aSAndrew Thompson if ((state.src[0] != 'u') || 298df4b8c2aSAndrew Thompson (state.src[1] != 'g') || 299df4b8c2aSAndrew Thompson (state.src[2] != 'e') || 300df4b8c2aSAndrew Thompson (state.src[3] != 'n')) { 301df4b8c2aSAndrew Thompson continue; 302df4b8c2aSAndrew Thompson } 303df4b8c2aSAndrew Thompson pdev = libusb20_dev_alloc(); 304df4b8c2aSAndrew Thompson if (pdev == NULL) { 305df4b8c2aSAndrew Thompson continue; 306df4b8c2aSAndrew Thompson } 307df4b8c2aSAndrew Thompson if (ugen20_enumerate(pdev, state.src + 4)) { 308df4b8c2aSAndrew Thompson libusb20_dev_free(pdev); 309df4b8c2aSAndrew Thompson continue; 310df4b8c2aSAndrew Thompson } 311df4b8c2aSAndrew Thompson /* put the device on the backend list */ 312df4b8c2aSAndrew Thompson libusb20_be_enqueue_device(pbe, pdev); 313df4b8c2aSAndrew Thompson } 314df4b8c2aSAndrew Thompson close(state.f); 315df4b8c2aSAndrew Thompson return (0); /* success */ 316df4b8c2aSAndrew Thompson } 317df4b8c2aSAndrew Thompson 318df4b8c2aSAndrew Thompson static void 319df4b8c2aSAndrew Thompson ugen20_tr_release(struct libusb20_device *pdev) 320df4b8c2aSAndrew Thompson { 321760bc48eSAndrew Thompson struct usb_fs_uninit fs_uninit; 322df4b8c2aSAndrew Thompson 323df4b8c2aSAndrew Thompson if (pdev->nTransfer == 0) { 324df4b8c2aSAndrew Thompson return; 325df4b8c2aSAndrew Thompson } 326df4b8c2aSAndrew Thompson /* release all pending USB transfers */ 327df4b8c2aSAndrew Thompson if (pdev->privBeData != NULL) { 328df4b8c2aSAndrew Thompson memset(&fs_uninit, 0, sizeof(fs_uninit)); 32999cd1f32SHans Petter Selasky if (ioctl(pdev->file, IOUSB(USB_FS_UNINIT), &fs_uninit)) { 330df4b8c2aSAndrew Thompson /* ignore any errors of this kind */ 331df4b8c2aSAndrew Thompson } 332df4b8c2aSAndrew Thompson } 333df4b8c2aSAndrew Thompson return; 334df4b8c2aSAndrew Thompson } 335df4b8c2aSAndrew Thompson 336df4b8c2aSAndrew Thompson static int 337df4b8c2aSAndrew Thompson ugen20_tr_renew(struct libusb20_device *pdev) 338df4b8c2aSAndrew Thompson { 339760bc48eSAndrew Thompson struct usb_fs_init fs_init; 340760bc48eSAndrew Thompson struct usb_fs_endpoint *pfse; 341df4b8c2aSAndrew Thompson int error; 342df4b8c2aSAndrew Thompson uint32_t size; 343df4b8c2aSAndrew Thompson uint16_t nMaxTransfer; 344df4b8c2aSAndrew Thompson 345df4b8c2aSAndrew Thompson nMaxTransfer = pdev->nTransfer; 346df4b8c2aSAndrew Thompson error = 0; 347df4b8c2aSAndrew Thompson 348df4b8c2aSAndrew Thompson if (nMaxTransfer == 0) { 349df4b8c2aSAndrew Thompson goto done; 350df4b8c2aSAndrew Thompson } 351df4b8c2aSAndrew Thompson size = nMaxTransfer * sizeof(*pfse); 352df4b8c2aSAndrew Thompson 353df4b8c2aSAndrew Thompson if (pdev->privBeData == NULL) { 354df4b8c2aSAndrew Thompson pfse = malloc(size); 355df4b8c2aSAndrew Thompson if (pfse == NULL) { 356df4b8c2aSAndrew Thompson error = LIBUSB20_ERROR_NO_MEM; 357df4b8c2aSAndrew Thompson goto done; 358df4b8c2aSAndrew Thompson } 359df4b8c2aSAndrew Thompson pdev->privBeData = pfse; 360df4b8c2aSAndrew Thompson } 361df4b8c2aSAndrew Thompson /* reset endpoint data */ 362df4b8c2aSAndrew Thompson memset(pdev->privBeData, 0, size); 363df4b8c2aSAndrew Thompson 364df4b8c2aSAndrew Thompson memset(&fs_init, 0, sizeof(fs_init)); 365df4b8c2aSAndrew Thompson 36651fd3d75SHans Petter Selasky fs_init.pEndpoints = libusb20_pass_ptr(pdev->privBeData); 367df4b8c2aSAndrew Thompson fs_init.ep_index_max = nMaxTransfer; 368df4b8c2aSAndrew Thompson 36999cd1f32SHans Petter Selasky if (ioctl(pdev->file, IOUSB(USB_FS_INIT), &fs_init)) { 370df4b8c2aSAndrew Thompson error = LIBUSB20_ERROR_OTHER; 371df4b8c2aSAndrew Thompson goto done; 372df4b8c2aSAndrew Thompson } 373df4b8c2aSAndrew Thompson done: 374df4b8c2aSAndrew Thompson return (error); 375df4b8c2aSAndrew Thompson } 376df4b8c2aSAndrew Thompson 377df4b8c2aSAndrew Thompson static int 378df4b8c2aSAndrew Thompson ugen20_open_device(struct libusb20_device *pdev, uint16_t nMaxTransfer) 379df4b8c2aSAndrew Thompson { 380df4b8c2aSAndrew Thompson uint32_t plugtime; 381df4b8c2aSAndrew Thompson char buf[64]; 382df4b8c2aSAndrew Thompson int f; 383df4b8c2aSAndrew Thompson int g; 384df4b8c2aSAndrew Thompson int error; 385df4b8c2aSAndrew Thompson 386df4b8c2aSAndrew Thompson snprintf(buf, sizeof(buf), "/dev/" USB_GENERIC_NAME "%u.%u", 387df4b8c2aSAndrew Thompson pdev->bus_number, pdev->device_address); 388df4b8c2aSAndrew Thompson 389df4b8c2aSAndrew Thompson /* 390df4b8c2aSAndrew Thompson * We need two file handles, one for the control endpoint and one 391df4b8c2aSAndrew Thompson * for BULK, INTERRUPT and ISOCHRONOUS transactions due to optimised 392df4b8c2aSAndrew Thompson * kernel locking. 393df4b8c2aSAndrew Thompson */ 394df4b8c2aSAndrew Thompson g = open(buf, O_RDWR); 395df4b8c2aSAndrew Thompson if (g < 0) { 396df4b8c2aSAndrew Thompson return (LIBUSB20_ERROR_NO_DEVICE); 397df4b8c2aSAndrew Thompson } 398df4b8c2aSAndrew Thompson f = open(buf, O_RDWR); 399df4b8c2aSAndrew Thompson if (f < 0) { 400df4b8c2aSAndrew Thompson close(g); 401df4b8c2aSAndrew Thompson return (LIBUSB20_ERROR_NO_DEVICE); 402df4b8c2aSAndrew Thompson } 40399cd1f32SHans Petter Selasky if (ioctl(f, IOUSB(USB_GET_PLUGTIME), &plugtime)) { 404df4b8c2aSAndrew Thompson error = LIBUSB20_ERROR_OTHER; 405df4b8c2aSAndrew Thompson goto done; 406df4b8c2aSAndrew Thompson } 407df4b8c2aSAndrew Thompson /* check that the correct device is still plugged */ 408df4b8c2aSAndrew Thompson if (pdev->session_data.plugtime != plugtime) { 409df4b8c2aSAndrew Thompson error = LIBUSB20_ERROR_NO_DEVICE; 410df4b8c2aSAndrew Thompson goto done; 411df4b8c2aSAndrew Thompson } 412df4b8c2aSAndrew Thompson /* need to set this before "tr_renew()" */ 413df4b8c2aSAndrew Thompson pdev->file = f; 414df4b8c2aSAndrew Thompson pdev->file_ctrl = g; 415df4b8c2aSAndrew Thompson 416df4b8c2aSAndrew Thompson /* renew all USB transfers */ 417df4b8c2aSAndrew Thompson error = ugen20_tr_renew(pdev); 418df4b8c2aSAndrew Thompson if (error) { 419df4b8c2aSAndrew Thompson goto done; 420df4b8c2aSAndrew Thompson } 421df4b8c2aSAndrew Thompson /* set methods */ 422df4b8c2aSAndrew Thompson pdev->methods = &libusb20_ugen20_device_methods; 423df4b8c2aSAndrew Thompson 424df4b8c2aSAndrew Thompson done: 425df4b8c2aSAndrew Thompson if (error) { 426df4b8c2aSAndrew Thompson if (pdev->privBeData) { 427df4b8c2aSAndrew Thompson /* cleanup after "tr_renew()" */ 428df4b8c2aSAndrew Thompson free(pdev->privBeData); 429df4b8c2aSAndrew Thompson pdev->privBeData = NULL; 430df4b8c2aSAndrew Thompson } 431df4b8c2aSAndrew Thompson pdev->file = -1; 432df4b8c2aSAndrew Thompson pdev->file_ctrl = -1; 433df4b8c2aSAndrew Thompson close(f); 434df4b8c2aSAndrew Thompson close(g); 435df4b8c2aSAndrew Thompson } 436df4b8c2aSAndrew Thompson return (error); 437df4b8c2aSAndrew Thompson } 438df4b8c2aSAndrew Thompson 439df4b8c2aSAndrew Thompson static int 440df4b8c2aSAndrew Thompson ugen20_close_device(struct libusb20_device *pdev) 441df4b8c2aSAndrew Thompson { 442760bc48eSAndrew Thompson struct usb_fs_uninit fs_uninit; 443df4b8c2aSAndrew Thompson 444df4b8c2aSAndrew Thompson if (pdev->privBeData) { 445df4b8c2aSAndrew Thompson memset(&fs_uninit, 0, sizeof(fs_uninit)); 44699cd1f32SHans Petter Selasky if (ioctl(pdev->file, IOUSB(USB_FS_UNINIT), &fs_uninit)) { 447df4b8c2aSAndrew Thompson /* ignore this error */ 448df4b8c2aSAndrew Thompson } 449df4b8c2aSAndrew Thompson free(pdev->privBeData); 450df4b8c2aSAndrew Thompson } 451df4b8c2aSAndrew Thompson pdev->nTransfer = 0; 452df4b8c2aSAndrew Thompson pdev->privBeData = NULL; 453df4b8c2aSAndrew Thompson close(pdev->file); 454df4b8c2aSAndrew Thompson close(pdev->file_ctrl); 455df4b8c2aSAndrew Thompson pdev->file = -1; 456df4b8c2aSAndrew Thompson pdev->file_ctrl = -1; 457df4b8c2aSAndrew Thompson return (0); /* success */ 458df4b8c2aSAndrew Thompson } 459df4b8c2aSAndrew Thompson 460df4b8c2aSAndrew Thompson static void 461df4b8c2aSAndrew Thompson ugen20_exit_backend(struct libusb20_backend *pbe) 462df4b8c2aSAndrew Thompson { 463df4b8c2aSAndrew Thompson return; /* nothing to do */ 464df4b8c2aSAndrew Thompson } 465df4b8c2aSAndrew Thompson 466df4b8c2aSAndrew Thompson static int 467df4b8c2aSAndrew Thompson ugen20_get_config_desc_full(struct libusb20_device *pdev, 468df4b8c2aSAndrew Thompson uint8_t **ppbuf, uint16_t *plen, uint8_t cfg_index) 469df4b8c2aSAndrew Thompson { 470760bc48eSAndrew Thompson struct usb_gen_descriptor gen_desc; 471760bc48eSAndrew Thompson struct usb_config_descriptor cdesc; 472df4b8c2aSAndrew Thompson uint8_t *ptr; 473df4b8c2aSAndrew Thompson uint16_t len; 474df4b8c2aSAndrew Thompson int error; 475df4b8c2aSAndrew Thompson 476ccef4ddfSAndrew Thompson /* make sure memory is initialised */ 477ccef4ddfSAndrew Thompson memset(&cdesc, 0, sizeof(cdesc)); 478df4b8c2aSAndrew Thompson memset(&gen_desc, 0, sizeof(gen_desc)); 479df4b8c2aSAndrew Thompson 48051fd3d75SHans Petter Selasky gen_desc.ugd_data = libusb20_pass_ptr(&cdesc); 481df4b8c2aSAndrew Thompson gen_desc.ugd_maxlen = sizeof(cdesc); 482df4b8c2aSAndrew Thompson gen_desc.ugd_config_index = cfg_index; 483df4b8c2aSAndrew Thompson 48499cd1f32SHans Petter Selasky error = ioctl(pdev->file_ctrl, IOUSB(USB_GET_FULL_DESC), &gen_desc); 485df4b8c2aSAndrew Thompson if (error) { 486df4b8c2aSAndrew Thompson return (LIBUSB20_ERROR_OTHER); 487df4b8c2aSAndrew Thompson } 488df4b8c2aSAndrew Thompson len = UGETW(cdesc.wTotalLength); 489df4b8c2aSAndrew Thompson if (len < sizeof(cdesc)) { 490df4b8c2aSAndrew Thompson /* corrupt descriptor */ 491df4b8c2aSAndrew Thompson return (LIBUSB20_ERROR_OTHER); 492df4b8c2aSAndrew Thompson } 493df4b8c2aSAndrew Thompson ptr = malloc(len); 494df4b8c2aSAndrew Thompson if (!ptr) { 495df4b8c2aSAndrew Thompson return (LIBUSB20_ERROR_NO_MEM); 496df4b8c2aSAndrew Thompson } 497ccef4ddfSAndrew Thompson 498ccef4ddfSAndrew Thompson /* make sure memory is initialised */ 499ccef4ddfSAndrew Thompson memset(ptr, 0, len); 500ccef4ddfSAndrew Thompson 50151fd3d75SHans Petter Selasky gen_desc.ugd_data = libusb20_pass_ptr(ptr); 502df4b8c2aSAndrew Thompson gen_desc.ugd_maxlen = len; 503df4b8c2aSAndrew Thompson 50499cd1f32SHans Petter Selasky error = ioctl(pdev->file_ctrl, IOUSB(USB_GET_FULL_DESC), &gen_desc); 505df4b8c2aSAndrew Thompson if (error) { 506df4b8c2aSAndrew Thompson free(ptr); 507df4b8c2aSAndrew Thompson return (LIBUSB20_ERROR_OTHER); 508df4b8c2aSAndrew Thompson } 509df4b8c2aSAndrew Thompson /* make sure that the device doesn't fool us */ 510df4b8c2aSAndrew Thompson memcpy(ptr, &cdesc, sizeof(cdesc)); 511df4b8c2aSAndrew Thompson 512df4b8c2aSAndrew Thompson *ppbuf = ptr; 513df4b8c2aSAndrew Thompson *plen = len; 514df4b8c2aSAndrew Thompson 515df4b8c2aSAndrew Thompson return (0); /* success */ 516df4b8c2aSAndrew Thompson } 517df4b8c2aSAndrew Thompson 518df4b8c2aSAndrew Thompson static int 519df4b8c2aSAndrew Thompson ugen20_get_config_index(struct libusb20_device *pdev, uint8_t *pindex) 520df4b8c2aSAndrew Thompson { 521df4b8c2aSAndrew Thompson int temp; 522df4b8c2aSAndrew Thompson 52399cd1f32SHans Petter Selasky if (ioctl(pdev->file_ctrl, IOUSB(USB_GET_CONFIG), &temp)) { 524df4b8c2aSAndrew Thompson return (LIBUSB20_ERROR_OTHER); 525df4b8c2aSAndrew Thompson } 526df4b8c2aSAndrew Thompson *pindex = temp; 527df4b8c2aSAndrew Thompson 528df4b8c2aSAndrew Thompson return (0); 529df4b8c2aSAndrew Thompson } 530df4b8c2aSAndrew Thompson 531df4b8c2aSAndrew Thompson static int 532df4b8c2aSAndrew Thompson ugen20_set_config_index(struct libusb20_device *pdev, uint8_t cfg_index) 533df4b8c2aSAndrew Thompson { 534df4b8c2aSAndrew Thompson int temp = cfg_index; 535df4b8c2aSAndrew Thompson 536df4b8c2aSAndrew Thompson /* release all active USB transfers */ 537df4b8c2aSAndrew Thompson ugen20_tr_release(pdev); 538df4b8c2aSAndrew Thompson 53999cd1f32SHans Petter Selasky if (ioctl(pdev->file_ctrl, IOUSB(USB_SET_CONFIG), &temp)) { 540df4b8c2aSAndrew Thompson return (LIBUSB20_ERROR_OTHER); 541df4b8c2aSAndrew Thompson } 542df4b8c2aSAndrew Thompson return (ugen20_tr_renew(pdev)); 543df4b8c2aSAndrew Thompson } 544df4b8c2aSAndrew Thompson 545df4b8c2aSAndrew Thompson static int 546df4b8c2aSAndrew Thompson ugen20_set_alt_index(struct libusb20_device *pdev, 547df4b8c2aSAndrew Thompson uint8_t iface_index, uint8_t alt_index) 548df4b8c2aSAndrew Thompson { 549760bc48eSAndrew Thompson struct usb_alt_interface alt_iface; 550df4b8c2aSAndrew Thompson 551df4b8c2aSAndrew Thompson memset(&alt_iface, 0, sizeof(alt_iface)); 552df4b8c2aSAndrew Thompson 553df4b8c2aSAndrew Thompson alt_iface.uai_interface_index = iface_index; 554df4b8c2aSAndrew Thompson alt_iface.uai_alt_index = alt_index; 555df4b8c2aSAndrew Thompson 556df4b8c2aSAndrew Thompson /* release all active USB transfers */ 557df4b8c2aSAndrew Thompson ugen20_tr_release(pdev); 558df4b8c2aSAndrew Thompson 55999cd1f32SHans Petter Selasky if (ioctl(pdev->file_ctrl, IOUSB(USB_SET_ALTINTERFACE), &alt_iface)) { 560df4b8c2aSAndrew Thompson return (LIBUSB20_ERROR_OTHER); 561df4b8c2aSAndrew Thompson } 562df4b8c2aSAndrew Thompson return (ugen20_tr_renew(pdev)); 563df4b8c2aSAndrew Thompson } 564df4b8c2aSAndrew Thompson 565df4b8c2aSAndrew Thompson static int 566df4b8c2aSAndrew Thompson ugen20_reset_device(struct libusb20_device *pdev) 567df4b8c2aSAndrew Thompson { 568df4b8c2aSAndrew Thompson int temp = 0; 569df4b8c2aSAndrew Thompson 570df4b8c2aSAndrew Thompson /* release all active USB transfers */ 571df4b8c2aSAndrew Thompson ugen20_tr_release(pdev); 572df4b8c2aSAndrew Thompson 57399cd1f32SHans Petter Selasky if (ioctl(pdev->file_ctrl, IOUSB(USB_DEVICEENUMERATE), &temp)) { 574df4b8c2aSAndrew Thompson return (LIBUSB20_ERROR_OTHER); 575df4b8c2aSAndrew Thompson } 576df4b8c2aSAndrew Thompson return (ugen20_tr_renew(pdev)); 577df4b8c2aSAndrew Thompson } 578df4b8c2aSAndrew Thompson 579df4b8c2aSAndrew Thompson static int 580e50ac68bSAndrew Thompson ugen20_check_connected(struct libusb20_device *pdev) 581e50ac68bSAndrew Thompson { 582e50ac68bSAndrew Thompson uint32_t plugtime; 583e50ac68bSAndrew Thompson int error = 0; 584e50ac68bSAndrew Thompson 58599cd1f32SHans Petter Selasky if (ioctl(pdev->file_ctrl, IOUSB(USB_GET_PLUGTIME), &plugtime)) { 586e50ac68bSAndrew Thompson error = LIBUSB20_ERROR_NO_DEVICE; 587e50ac68bSAndrew Thompson goto done; 588e50ac68bSAndrew Thompson } 589e50ac68bSAndrew Thompson 590e50ac68bSAndrew Thompson if (pdev->session_data.plugtime != plugtime) { 591e50ac68bSAndrew Thompson error = LIBUSB20_ERROR_NO_DEVICE; 592e50ac68bSAndrew Thompson goto done; 593e50ac68bSAndrew Thompson } 594e50ac68bSAndrew Thompson done: 595e50ac68bSAndrew Thompson return (error); 596e50ac68bSAndrew Thompson } 597e50ac68bSAndrew Thompson 598e50ac68bSAndrew Thompson static int 599df4b8c2aSAndrew Thompson ugen20_set_power_mode(struct libusb20_device *pdev, uint8_t power_mode) 600df4b8c2aSAndrew Thompson { 601df4b8c2aSAndrew Thompson int temp; 602df4b8c2aSAndrew Thompson 603df4b8c2aSAndrew Thompson switch (power_mode) { 604df4b8c2aSAndrew Thompson case LIBUSB20_POWER_OFF: 605df4b8c2aSAndrew Thompson temp = USB_POWER_MODE_OFF; 606df4b8c2aSAndrew Thompson break; 607df4b8c2aSAndrew Thompson case LIBUSB20_POWER_ON: 608df4b8c2aSAndrew Thompson temp = USB_POWER_MODE_ON; 609df4b8c2aSAndrew Thompson break; 610df4b8c2aSAndrew Thompson case LIBUSB20_POWER_SAVE: 611df4b8c2aSAndrew Thompson temp = USB_POWER_MODE_SAVE; 612df4b8c2aSAndrew Thompson break; 613df4b8c2aSAndrew Thompson case LIBUSB20_POWER_SUSPEND: 614df4b8c2aSAndrew Thompson temp = USB_POWER_MODE_SUSPEND; 615df4b8c2aSAndrew Thompson break; 616df4b8c2aSAndrew Thompson case LIBUSB20_POWER_RESUME: 617df4b8c2aSAndrew Thompson temp = USB_POWER_MODE_RESUME; 618df4b8c2aSAndrew Thompson break; 619df4b8c2aSAndrew Thompson default: 620df4b8c2aSAndrew Thompson return (LIBUSB20_ERROR_INVALID_PARAM); 621df4b8c2aSAndrew Thompson } 62299cd1f32SHans Petter Selasky if (ioctl(pdev->file_ctrl, IOUSB(USB_SET_POWER_MODE), &temp)) { 623df4b8c2aSAndrew Thompson return (LIBUSB20_ERROR_OTHER); 624df4b8c2aSAndrew Thompson } 625df4b8c2aSAndrew Thompson return (0); 626df4b8c2aSAndrew Thompson } 627df4b8c2aSAndrew Thompson 628df4b8c2aSAndrew Thompson static int 629df4b8c2aSAndrew Thompson ugen20_get_power_mode(struct libusb20_device *pdev, uint8_t *power_mode) 630df4b8c2aSAndrew Thompson { 631df4b8c2aSAndrew Thompson int temp; 632df4b8c2aSAndrew Thompson 63399cd1f32SHans Petter Selasky if (ioctl(pdev->file_ctrl, IOUSB(USB_GET_POWER_MODE), &temp)) { 634df4b8c2aSAndrew Thompson return (LIBUSB20_ERROR_OTHER); 635df4b8c2aSAndrew Thompson } 636df4b8c2aSAndrew Thompson switch (temp) { 637df4b8c2aSAndrew Thompson case USB_POWER_MODE_OFF: 638df4b8c2aSAndrew Thompson temp = LIBUSB20_POWER_OFF; 639df4b8c2aSAndrew Thompson break; 640df4b8c2aSAndrew Thompson case USB_POWER_MODE_ON: 641df4b8c2aSAndrew Thompson temp = LIBUSB20_POWER_ON; 642df4b8c2aSAndrew Thompson break; 643df4b8c2aSAndrew Thompson case USB_POWER_MODE_SAVE: 644df4b8c2aSAndrew Thompson temp = LIBUSB20_POWER_SAVE; 645df4b8c2aSAndrew Thompson break; 646df4b8c2aSAndrew Thompson case USB_POWER_MODE_SUSPEND: 647df4b8c2aSAndrew Thompson temp = LIBUSB20_POWER_SUSPEND; 648df4b8c2aSAndrew Thompson break; 649df4b8c2aSAndrew Thompson case USB_POWER_MODE_RESUME: 650df4b8c2aSAndrew Thompson temp = LIBUSB20_POWER_RESUME; 651df4b8c2aSAndrew Thompson break; 652df4b8c2aSAndrew Thompson default: 653df4b8c2aSAndrew Thompson temp = LIBUSB20_POWER_ON; 654df4b8c2aSAndrew Thompson break; 655df4b8c2aSAndrew Thompson } 656df4b8c2aSAndrew Thompson *power_mode = temp; 657df4b8c2aSAndrew Thompson return (0); /* success */ 658df4b8c2aSAndrew Thompson } 659df4b8c2aSAndrew Thompson 660df4b8c2aSAndrew Thompson static int 661aafcb732SHans Petter Selasky ugen20_get_power_usage(struct libusb20_device *pdev, uint16_t *power_usage) 662aafcb732SHans Petter Selasky { 663aafcb732SHans Petter Selasky int temp; 664aafcb732SHans Petter Selasky 66599cd1f32SHans Petter Selasky if (ioctl(pdev->file_ctrl, IOUSB(USB_GET_POWER_USAGE), &temp)) { 666aafcb732SHans Petter Selasky return (LIBUSB20_ERROR_OTHER); 667aafcb732SHans Petter Selasky } 668aafcb732SHans Petter Selasky *power_usage = temp; 669aafcb732SHans Petter Selasky return (0); /* success */ 670aafcb732SHans Petter Selasky } 671aafcb732SHans Petter Selasky 672aafcb732SHans Petter Selasky static int 673df4b8c2aSAndrew Thompson ugen20_kernel_driver_active(struct libusb20_device *pdev, 674df4b8c2aSAndrew Thompson uint8_t iface_index) 675df4b8c2aSAndrew Thompson { 676df4b8c2aSAndrew Thompson int temp = iface_index; 677df4b8c2aSAndrew Thompson 67899cd1f32SHans Petter Selasky if (ioctl(pdev->file_ctrl, IOUSB(USB_IFACE_DRIVER_ACTIVE), &temp)) { 679df4b8c2aSAndrew Thompson return (LIBUSB20_ERROR_OTHER); 680df4b8c2aSAndrew Thompson } 681df4b8c2aSAndrew Thompson return (0); /* kernel driver is active */ 682df4b8c2aSAndrew Thompson } 683df4b8c2aSAndrew Thompson 684df4b8c2aSAndrew Thompson static int 685df4b8c2aSAndrew Thompson ugen20_detach_kernel_driver(struct libusb20_device *pdev, 686df4b8c2aSAndrew Thompson uint8_t iface_index) 687df4b8c2aSAndrew Thompson { 688df4b8c2aSAndrew Thompson int temp = iface_index; 689df4b8c2aSAndrew Thompson 69099cd1f32SHans Petter Selasky if (ioctl(pdev->file_ctrl, IOUSB(USB_IFACE_DRIVER_DETACH), &temp)) { 691df4b8c2aSAndrew Thompson return (LIBUSB20_ERROR_OTHER); 692df4b8c2aSAndrew Thompson } 6935122043eSHans Petter Selasky return (0); /* kernel driver is detached */ 694df4b8c2aSAndrew Thompson } 695df4b8c2aSAndrew Thompson 696df4b8c2aSAndrew Thompson static int 697df4b8c2aSAndrew Thompson ugen20_do_request_sync(struct libusb20_device *pdev, 698df4b8c2aSAndrew Thompson struct LIBUSB20_CONTROL_SETUP_DECODED *setup, 699df4b8c2aSAndrew Thompson void *data, uint16_t *pactlen, uint32_t timeout, uint8_t flags) 700df4b8c2aSAndrew Thompson { 701760bc48eSAndrew Thompson struct usb_ctl_request req; 702df4b8c2aSAndrew Thompson 703df4b8c2aSAndrew Thompson memset(&req, 0, sizeof(req)); 704df4b8c2aSAndrew Thompson 70551fd3d75SHans Petter Selasky req.ucr_data = libusb20_pass_ptr(data); 706df4b8c2aSAndrew Thompson if (!(flags & LIBUSB20_TRANSFER_SINGLE_SHORT_NOT_OK)) { 707df4b8c2aSAndrew Thompson req.ucr_flags |= USB_SHORT_XFER_OK; 708df4b8c2aSAndrew Thompson } 709df4b8c2aSAndrew Thompson if (libusb20_me_encode(&req.ucr_request, 710df4b8c2aSAndrew Thompson sizeof(req.ucr_request), setup)) { 711df4b8c2aSAndrew Thompson /* ignore */ 712df4b8c2aSAndrew Thompson } 71399cd1f32SHans Petter Selasky if (ioctl(pdev->file_ctrl, IOUSB(USB_DO_REQUEST), &req)) { 714df4b8c2aSAndrew Thompson return (LIBUSB20_ERROR_OTHER); 715df4b8c2aSAndrew Thompson } 716df4b8c2aSAndrew Thompson if (pactlen) { 717df4b8c2aSAndrew Thompson /* get actual length */ 718df4b8c2aSAndrew Thompson *pactlen = req.ucr_actlen; 719df4b8c2aSAndrew Thompson } 7205122043eSHans Petter Selasky return (0); /* request was successful */ 721df4b8c2aSAndrew Thompson } 722df4b8c2aSAndrew Thompson 723df4b8c2aSAndrew Thompson static int 724df4b8c2aSAndrew Thompson ugen20_process(struct libusb20_device *pdev) 725df4b8c2aSAndrew Thompson { 726760bc48eSAndrew Thompson struct usb_fs_complete temp; 727760bc48eSAndrew Thompson struct usb_fs_endpoint *fsep; 728df4b8c2aSAndrew Thompson struct libusb20_transfer *xfer; 729df4b8c2aSAndrew Thompson 730df4b8c2aSAndrew Thompson while (1) { 731df4b8c2aSAndrew Thompson 73299cd1f32SHans Petter Selasky if (ioctl(pdev->file, IOUSB(USB_FS_COMPLETE), &temp)) { 733df4b8c2aSAndrew Thompson if (errno == EBUSY) { 734df4b8c2aSAndrew Thompson break; 735df4b8c2aSAndrew Thompson } else { 736df4b8c2aSAndrew Thompson /* device detached */ 737df4b8c2aSAndrew Thompson return (LIBUSB20_ERROR_OTHER); 738df4b8c2aSAndrew Thompson } 739df4b8c2aSAndrew Thompson } 740df4b8c2aSAndrew Thompson fsep = pdev->privBeData; 741df4b8c2aSAndrew Thompson xfer = pdev->pTransfer; 742df4b8c2aSAndrew Thompson fsep += temp.ep_index; 743df4b8c2aSAndrew Thompson xfer += temp.ep_index; 744df4b8c2aSAndrew Thompson 745df4b8c2aSAndrew Thompson /* update transfer status */ 746df4b8c2aSAndrew Thompson 747df4b8c2aSAndrew Thompson if (fsep->status == 0) { 748df4b8c2aSAndrew Thompson xfer->aFrames = fsep->aFrames; 749df4b8c2aSAndrew Thompson xfer->timeComplete = fsep->isoc_time_complete; 750df4b8c2aSAndrew Thompson xfer->status = LIBUSB20_TRANSFER_COMPLETED; 751df4b8c2aSAndrew Thompson } else if (fsep->status == USB_ERR_CANCELLED) { 752df4b8c2aSAndrew Thompson xfer->aFrames = 0; 753df4b8c2aSAndrew Thompson xfer->timeComplete = 0; 754df4b8c2aSAndrew Thompson xfer->status = LIBUSB20_TRANSFER_CANCELLED; 755df4b8c2aSAndrew Thompson } else if (fsep->status == USB_ERR_STALLED) { 756df4b8c2aSAndrew Thompson xfer->aFrames = 0; 757df4b8c2aSAndrew Thompson xfer->timeComplete = 0; 758df4b8c2aSAndrew Thompson xfer->status = LIBUSB20_TRANSFER_STALL; 759df4b8c2aSAndrew Thompson } else if (fsep->status == USB_ERR_TIMEOUT) { 760df4b8c2aSAndrew Thompson xfer->aFrames = 0; 761df4b8c2aSAndrew Thompson xfer->timeComplete = 0; 762df4b8c2aSAndrew Thompson xfer->status = LIBUSB20_TRANSFER_TIMED_OUT; 763df4b8c2aSAndrew Thompson } else { 764df4b8c2aSAndrew Thompson xfer->aFrames = 0; 765df4b8c2aSAndrew Thompson xfer->timeComplete = 0; 766df4b8c2aSAndrew Thompson xfer->status = LIBUSB20_TRANSFER_ERROR; 767df4b8c2aSAndrew Thompson } 768df4b8c2aSAndrew Thompson libusb20_tr_callback_wrapper(xfer); 769df4b8c2aSAndrew Thompson } 770df4b8c2aSAndrew Thompson return (0); /* done */ 771df4b8c2aSAndrew Thompson } 772df4b8c2aSAndrew Thompson 773df4b8c2aSAndrew Thompson static int 774df4b8c2aSAndrew Thompson ugen20_tr_open(struct libusb20_transfer *xfer, uint32_t MaxBufSize, 77507b6ce3bSHans Petter Selasky uint32_t MaxFrameCount, uint8_t ep_no, uint16_t stream_id, 77607b6ce3bSHans Petter Selasky uint8_t pre_scale) 777df4b8c2aSAndrew Thompson { 77807b6ce3bSHans Petter Selasky union { 77907b6ce3bSHans Petter Selasky struct usb_fs_open fs_open; 78007b6ce3bSHans Petter Selasky struct usb_fs_open_stream fs_open_stream; 78107b6ce3bSHans Petter Selasky } temp; 782760bc48eSAndrew Thompson struct usb_fs_endpoint *fsep; 783df4b8c2aSAndrew Thompson 7841c497368SHans Petter Selasky if (pre_scale) 7851c497368SHans Petter Selasky MaxFrameCount |= USB_FS_MAX_FRAMES_PRE_SCALE; 7861c497368SHans Petter Selasky 787df4b8c2aSAndrew Thompson memset(&temp, 0, sizeof(temp)); 788df4b8c2aSAndrew Thompson 789df4b8c2aSAndrew Thompson fsep = xfer->pdev->privBeData; 790df4b8c2aSAndrew Thompson fsep += xfer->trIndex; 791df4b8c2aSAndrew Thompson 79207b6ce3bSHans Petter Selasky temp.fs_open.max_bufsize = MaxBufSize; 79307b6ce3bSHans Petter Selasky temp.fs_open.max_frames = MaxFrameCount; 79407b6ce3bSHans Petter Selasky temp.fs_open.ep_index = xfer->trIndex; 79507b6ce3bSHans Petter Selasky temp.fs_open.ep_no = ep_no; 796df4b8c2aSAndrew Thompson 79707b6ce3bSHans Petter Selasky if (stream_id != 0) { 79807b6ce3bSHans Petter Selasky temp.fs_open_stream.stream_id = stream_id; 79907b6ce3bSHans Petter Selasky 80099cd1f32SHans Petter Selasky if (ioctl(xfer->pdev->file, IOUSB(USB_FS_OPEN_STREAM), &temp.fs_open_stream)) 80107b6ce3bSHans Petter Selasky return (LIBUSB20_ERROR_INVALID_PARAM); 80207b6ce3bSHans Petter Selasky } else { 80399cd1f32SHans Petter Selasky if (ioctl(xfer->pdev->file, IOUSB(USB_FS_OPEN), &temp.fs_open)) 804df4b8c2aSAndrew Thompson return (LIBUSB20_ERROR_INVALID_PARAM); 805df4b8c2aSAndrew Thompson } 806df4b8c2aSAndrew Thompson /* maximums might have changed - update */ 80707b6ce3bSHans Petter Selasky xfer->maxFrames = temp.fs_open.max_frames; 808df4b8c2aSAndrew Thompson 809df4b8c2aSAndrew Thompson /* "max_bufsize" should be multiple of "max_packet_length" */ 81007b6ce3bSHans Petter Selasky xfer->maxTotalLength = temp.fs_open.max_bufsize; 81107b6ce3bSHans Petter Selasky xfer->maxPacketLen = temp.fs_open.max_packet_length; 812df4b8c2aSAndrew Thompson 81351fd3d75SHans Petter Selasky /* setup buffer and length lists using zero copy */ 81451fd3d75SHans Petter Selasky fsep->ppBuffer = libusb20_pass_ptr(xfer->ppBuffer); 81551fd3d75SHans Petter Selasky fsep->pLength = libusb20_pass_ptr(xfer->pLength); 816df4b8c2aSAndrew Thompson 817df4b8c2aSAndrew Thompson return (0); /* success */ 818df4b8c2aSAndrew Thompson } 819df4b8c2aSAndrew Thompson 820df4b8c2aSAndrew Thompson static int 821df4b8c2aSAndrew Thompson ugen20_tr_close(struct libusb20_transfer *xfer) 822df4b8c2aSAndrew Thompson { 823760bc48eSAndrew Thompson struct usb_fs_close temp; 824df4b8c2aSAndrew Thompson 825df4b8c2aSAndrew Thompson memset(&temp, 0, sizeof(temp)); 826df4b8c2aSAndrew Thompson 827df4b8c2aSAndrew Thompson temp.ep_index = xfer->trIndex; 828df4b8c2aSAndrew Thompson 82999cd1f32SHans Petter Selasky if (ioctl(xfer->pdev->file, IOUSB(USB_FS_CLOSE), &temp)) { 830df4b8c2aSAndrew Thompson return (LIBUSB20_ERROR_INVALID_PARAM); 831df4b8c2aSAndrew Thompson } 832df4b8c2aSAndrew Thompson return (0); /* success */ 833df4b8c2aSAndrew Thompson } 834df4b8c2aSAndrew Thompson 835df4b8c2aSAndrew Thompson static int 836df4b8c2aSAndrew Thompson ugen20_tr_clear_stall_sync(struct libusb20_transfer *xfer) 837df4b8c2aSAndrew Thompson { 838760bc48eSAndrew Thompson struct usb_fs_clear_stall_sync temp; 839df4b8c2aSAndrew Thompson 840df4b8c2aSAndrew Thompson memset(&temp, 0, sizeof(temp)); 841df4b8c2aSAndrew Thompson 842df4b8c2aSAndrew Thompson /* if the transfer is active, an error will be returned */ 843df4b8c2aSAndrew Thompson 844df4b8c2aSAndrew Thompson temp.ep_index = xfer->trIndex; 845df4b8c2aSAndrew Thompson 84699cd1f32SHans Petter Selasky if (ioctl(xfer->pdev->file, IOUSB(USB_FS_CLEAR_STALL_SYNC), &temp)) { 847df4b8c2aSAndrew Thompson return (LIBUSB20_ERROR_INVALID_PARAM); 848df4b8c2aSAndrew Thompson } 849df4b8c2aSAndrew Thompson return (0); /* success */ 850df4b8c2aSAndrew Thompson } 851df4b8c2aSAndrew Thompson 852df4b8c2aSAndrew Thompson static void 853df4b8c2aSAndrew Thompson ugen20_tr_submit(struct libusb20_transfer *xfer) 854df4b8c2aSAndrew Thompson { 855760bc48eSAndrew Thompson struct usb_fs_start temp; 856760bc48eSAndrew Thompson struct usb_fs_endpoint *fsep; 857df4b8c2aSAndrew Thompson 858df4b8c2aSAndrew Thompson memset(&temp, 0, sizeof(temp)); 859df4b8c2aSAndrew Thompson 860df4b8c2aSAndrew Thompson fsep = xfer->pdev->privBeData; 861df4b8c2aSAndrew Thompson fsep += xfer->trIndex; 862df4b8c2aSAndrew Thompson 863df4b8c2aSAndrew Thompson fsep->nFrames = xfer->nFrames; 864df4b8c2aSAndrew Thompson fsep->flags = 0; 865df4b8c2aSAndrew Thompson if (!(xfer->flags & LIBUSB20_TRANSFER_SINGLE_SHORT_NOT_OK)) { 866df4b8c2aSAndrew Thompson fsep->flags |= USB_FS_FLAG_SINGLE_SHORT_OK; 867df4b8c2aSAndrew Thompson } 868df4b8c2aSAndrew Thompson if (!(xfer->flags & LIBUSB20_TRANSFER_MULTI_SHORT_NOT_OK)) { 869df4b8c2aSAndrew Thompson fsep->flags |= USB_FS_FLAG_MULTI_SHORT_OK; 870df4b8c2aSAndrew Thompson } 871df4b8c2aSAndrew Thompson if (xfer->flags & LIBUSB20_TRANSFER_FORCE_SHORT) { 872df4b8c2aSAndrew Thompson fsep->flags |= USB_FS_FLAG_FORCE_SHORT; 873df4b8c2aSAndrew Thompson } 874df4b8c2aSAndrew Thompson if (xfer->flags & LIBUSB20_TRANSFER_DO_CLEAR_STALL) { 875df4b8c2aSAndrew Thompson fsep->flags |= USB_FS_FLAG_CLEAR_STALL; 876df4b8c2aSAndrew Thompson } 8770c35eaadSAndrew Thompson /* NOTE: The "fsep->timeout" variable is 16-bit. */ 8780c35eaadSAndrew Thompson if (xfer->timeout > 65535) 8790c35eaadSAndrew Thompson fsep->timeout = 65535; 8800c35eaadSAndrew Thompson else 881df4b8c2aSAndrew Thompson fsep->timeout = xfer->timeout; 882df4b8c2aSAndrew Thompson 883df4b8c2aSAndrew Thompson temp.ep_index = xfer->trIndex; 884df4b8c2aSAndrew Thompson 88599cd1f32SHans Petter Selasky if (ioctl(xfer->pdev->file, IOUSB(USB_FS_START), &temp)) { 886df4b8c2aSAndrew Thompson /* ignore any errors - should never happen */ 887df4b8c2aSAndrew Thompson } 888df4b8c2aSAndrew Thompson return; /* success */ 889df4b8c2aSAndrew Thompson } 890df4b8c2aSAndrew Thompson 891df4b8c2aSAndrew Thompson static void 892df4b8c2aSAndrew Thompson ugen20_tr_cancel_async(struct libusb20_transfer *xfer) 893df4b8c2aSAndrew Thompson { 894760bc48eSAndrew Thompson struct usb_fs_stop temp; 895df4b8c2aSAndrew Thompson 896df4b8c2aSAndrew Thompson memset(&temp, 0, sizeof(temp)); 897df4b8c2aSAndrew Thompson 898df4b8c2aSAndrew Thompson temp.ep_index = xfer->trIndex; 899df4b8c2aSAndrew Thompson 90099cd1f32SHans Petter Selasky if (ioctl(xfer->pdev->file, IOUSB(USB_FS_STOP), &temp)) { 901df4b8c2aSAndrew Thompson /* ignore any errors - should never happen */ 902df4b8c2aSAndrew Thompson } 903df4b8c2aSAndrew Thompson return; 904df4b8c2aSAndrew Thompson } 905df4b8c2aSAndrew Thompson 906df4b8c2aSAndrew Thompson static int 907df4b8c2aSAndrew Thompson ugen20_be_ioctl(uint32_t cmd, void *data) 908df4b8c2aSAndrew Thompson { 909df4b8c2aSAndrew Thompson int f; 910df4b8c2aSAndrew Thompson int error; 911df4b8c2aSAndrew Thompson 912df4b8c2aSAndrew Thompson f = open("/dev/" USB_DEVICE_NAME, O_RDONLY); 913df4b8c2aSAndrew Thompson if (f < 0) 914df4b8c2aSAndrew Thompson return (LIBUSB20_ERROR_OTHER); 915df4b8c2aSAndrew Thompson error = ioctl(f, cmd, data); 916df4b8c2aSAndrew Thompson if (error == -1) { 917df4b8c2aSAndrew Thompson if (errno == EPERM) { 918df4b8c2aSAndrew Thompson error = LIBUSB20_ERROR_ACCESS; 919df4b8c2aSAndrew Thompson } else { 920df4b8c2aSAndrew Thompson error = LIBUSB20_ERROR_OTHER; 921df4b8c2aSAndrew Thompson } 922df4b8c2aSAndrew Thompson } 923df4b8c2aSAndrew Thompson close(f); 924df4b8c2aSAndrew Thompson return (error); 925df4b8c2aSAndrew Thompson } 926df4b8c2aSAndrew Thompson 927df4b8c2aSAndrew Thompson static int 928df4b8c2aSAndrew Thompson ugen20_dev_get_iface_desc(struct libusb20_device *pdev, 929df4b8c2aSAndrew Thompson uint8_t iface_index, char *buf, uint8_t len) 930df4b8c2aSAndrew Thompson { 931760bc48eSAndrew Thompson struct usb_gen_descriptor ugd; 932df4b8c2aSAndrew Thompson 933df4b8c2aSAndrew Thompson memset(&ugd, 0, sizeof(ugd)); 934df4b8c2aSAndrew Thompson 93551fd3d75SHans Petter Selasky ugd.ugd_data = libusb20_pass_ptr(buf); 936df4b8c2aSAndrew Thompson ugd.ugd_maxlen = len; 937df4b8c2aSAndrew Thompson ugd.ugd_iface_index = iface_index; 938df4b8c2aSAndrew Thompson 93999cd1f32SHans Petter Selasky if (ioctl(pdev->file, IOUSB(USB_GET_IFACE_DRIVER), &ugd)) { 940df4b8c2aSAndrew Thompson return (LIBUSB20_ERROR_INVALID_PARAM); 941df4b8c2aSAndrew Thompson } 942df4b8c2aSAndrew Thompson return (0); 943df4b8c2aSAndrew Thompson } 944df4b8c2aSAndrew Thompson 945df4b8c2aSAndrew Thompson static int 946df4b8c2aSAndrew Thompson ugen20_dev_get_info(struct libusb20_device *pdev, 947760bc48eSAndrew Thompson struct usb_device_info *pinfo) 948df4b8c2aSAndrew Thompson { 94999cd1f32SHans Petter Selasky if (ioctl(pdev->file, IOUSB(USB_GET_DEVICEINFO), pinfo)) { 950df4b8c2aSAndrew Thompson return (LIBUSB20_ERROR_INVALID_PARAM); 951df4b8c2aSAndrew Thompson } 952df4b8c2aSAndrew Thompson return (0); 953df4b8c2aSAndrew Thompson } 954df4b8c2aSAndrew Thompson 955df4b8c2aSAndrew Thompson static int 956df4b8c2aSAndrew Thompson ugen20_root_get_dev_quirk(struct libusb20_backend *pbe, 957df4b8c2aSAndrew Thompson uint16_t quirk_index, struct libusb20_quirk *pq) 958df4b8c2aSAndrew Thompson { 959760bc48eSAndrew Thompson struct usb_gen_quirk q; 960df4b8c2aSAndrew Thompson int error; 961df4b8c2aSAndrew Thompson 962df4b8c2aSAndrew Thompson memset(&q, 0, sizeof(q)); 963df4b8c2aSAndrew Thompson 964df4b8c2aSAndrew Thompson q.index = quirk_index; 965df4b8c2aSAndrew Thompson 96699cd1f32SHans Petter Selasky error = ugen20_be_ioctl(IOUSB(USB_DEV_QUIRK_GET), &q); 967df4b8c2aSAndrew Thompson 968df4b8c2aSAndrew Thompson if (error) { 969df4b8c2aSAndrew Thompson if (errno == EINVAL) { 970df4b8c2aSAndrew Thompson return (LIBUSB20_ERROR_NOT_FOUND); 971df4b8c2aSAndrew Thompson } 972df4b8c2aSAndrew Thompson } else { 973df4b8c2aSAndrew Thompson pq->vid = q.vid; 974df4b8c2aSAndrew Thompson pq->pid = q.pid; 975df4b8c2aSAndrew Thompson pq->bcdDeviceLow = q.bcdDeviceLow; 976df4b8c2aSAndrew Thompson pq->bcdDeviceHigh = q.bcdDeviceHigh; 977df4b8c2aSAndrew Thompson strlcpy(pq->quirkname, q.quirkname, sizeof(pq->quirkname)); 978df4b8c2aSAndrew Thompson } 979df4b8c2aSAndrew Thompson return (error); 980df4b8c2aSAndrew Thompson } 981df4b8c2aSAndrew Thompson 982df4b8c2aSAndrew Thompson static int 983df4b8c2aSAndrew Thompson ugen20_root_get_quirk_name(struct libusb20_backend *pbe, uint16_t quirk_index, 984df4b8c2aSAndrew Thompson struct libusb20_quirk *pq) 985df4b8c2aSAndrew Thompson { 986760bc48eSAndrew Thompson struct usb_gen_quirk q; 987df4b8c2aSAndrew Thompson int error; 988df4b8c2aSAndrew Thompson 989df4b8c2aSAndrew Thompson memset(&q, 0, sizeof(q)); 990df4b8c2aSAndrew Thompson 991df4b8c2aSAndrew Thompson q.index = quirk_index; 992df4b8c2aSAndrew Thompson 99399cd1f32SHans Petter Selasky error = ugen20_be_ioctl(IOUSB(USB_QUIRK_NAME_GET), &q); 994df4b8c2aSAndrew Thompson 995df4b8c2aSAndrew Thompson if (error) { 996df4b8c2aSAndrew Thompson if (errno == EINVAL) { 997df4b8c2aSAndrew Thompson return (LIBUSB20_ERROR_NOT_FOUND); 998df4b8c2aSAndrew Thompson } 999df4b8c2aSAndrew Thompson } else { 1000df4b8c2aSAndrew Thompson strlcpy(pq->quirkname, q.quirkname, sizeof(pq->quirkname)); 1001df4b8c2aSAndrew Thompson } 1002df4b8c2aSAndrew Thompson return (error); 1003df4b8c2aSAndrew Thompson } 1004df4b8c2aSAndrew Thompson 1005df4b8c2aSAndrew Thompson static int 1006df4b8c2aSAndrew Thompson ugen20_root_add_dev_quirk(struct libusb20_backend *pbe, 1007df4b8c2aSAndrew Thompson struct libusb20_quirk *pq) 1008df4b8c2aSAndrew Thompson { 1009760bc48eSAndrew Thompson struct usb_gen_quirk q; 1010df4b8c2aSAndrew Thompson int error; 1011df4b8c2aSAndrew Thompson 1012df4b8c2aSAndrew Thompson memset(&q, 0, sizeof(q)); 1013df4b8c2aSAndrew Thompson 1014df4b8c2aSAndrew Thompson q.vid = pq->vid; 1015df4b8c2aSAndrew Thompson q.pid = pq->pid; 1016df4b8c2aSAndrew Thompson q.bcdDeviceLow = pq->bcdDeviceLow; 1017df4b8c2aSAndrew Thompson q.bcdDeviceHigh = pq->bcdDeviceHigh; 1018df4b8c2aSAndrew Thompson strlcpy(q.quirkname, pq->quirkname, sizeof(q.quirkname)); 1019df4b8c2aSAndrew Thompson 102099cd1f32SHans Petter Selasky error = ugen20_be_ioctl(IOUSB(USB_DEV_QUIRK_ADD), &q); 1021df4b8c2aSAndrew Thompson if (error) { 1022df4b8c2aSAndrew Thompson if (errno == ENOMEM) { 1023df4b8c2aSAndrew Thompson return (LIBUSB20_ERROR_NO_MEM); 1024df4b8c2aSAndrew Thompson } 1025df4b8c2aSAndrew Thompson } 1026df4b8c2aSAndrew Thompson return (error); 1027df4b8c2aSAndrew Thompson } 1028df4b8c2aSAndrew Thompson 1029df4b8c2aSAndrew Thompson static int 1030df4b8c2aSAndrew Thompson ugen20_root_remove_dev_quirk(struct libusb20_backend *pbe, 1031df4b8c2aSAndrew Thompson struct libusb20_quirk *pq) 1032df4b8c2aSAndrew Thompson { 1033760bc48eSAndrew Thompson struct usb_gen_quirk q; 1034df4b8c2aSAndrew Thompson int error; 1035df4b8c2aSAndrew Thompson 1036df4b8c2aSAndrew Thompson memset(&q, 0, sizeof(q)); 1037df4b8c2aSAndrew Thompson 1038df4b8c2aSAndrew Thompson q.vid = pq->vid; 1039df4b8c2aSAndrew Thompson q.pid = pq->pid; 1040df4b8c2aSAndrew Thompson q.bcdDeviceLow = pq->bcdDeviceLow; 1041df4b8c2aSAndrew Thompson q.bcdDeviceHigh = pq->bcdDeviceHigh; 1042df4b8c2aSAndrew Thompson strlcpy(q.quirkname, pq->quirkname, sizeof(q.quirkname)); 1043df4b8c2aSAndrew Thompson 104499cd1f32SHans Petter Selasky error = ugen20_be_ioctl(IOUSB(USB_DEV_QUIRK_REMOVE), &q); 1045df4b8c2aSAndrew Thompson if (error) { 1046df4b8c2aSAndrew Thompson if (errno == EINVAL) { 1047df4b8c2aSAndrew Thompson return (LIBUSB20_ERROR_NOT_FOUND); 1048df4b8c2aSAndrew Thompson } 1049df4b8c2aSAndrew Thompson } 1050df4b8c2aSAndrew Thompson return (error); 1051df4b8c2aSAndrew Thompson } 1052df4b8c2aSAndrew Thompson 1053df4b8c2aSAndrew Thompson static int 1054df4b8c2aSAndrew Thompson ugen20_root_set_template(struct libusb20_backend *pbe, int temp) 1055df4b8c2aSAndrew Thompson { 105699cd1f32SHans Petter Selasky return (ugen20_be_ioctl(IOUSB(USB_SET_TEMPLATE), &temp)); 1057df4b8c2aSAndrew Thompson } 1058df4b8c2aSAndrew Thompson 1059df4b8c2aSAndrew Thompson static int 1060df4b8c2aSAndrew Thompson ugen20_root_get_template(struct libusb20_backend *pbe, int *ptemp) 1061df4b8c2aSAndrew Thompson { 106299cd1f32SHans Petter Selasky return (ugen20_be_ioctl(IOUSB(USB_GET_TEMPLATE), ptemp)); 1063df4b8c2aSAndrew Thompson } 1064