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; 83*34b0ca24SHans Petter Selasky static libusb20_get_stats_t ugen20_get_stats; 84df4b8c2aSAndrew Thompson static libusb20_kernel_driver_active_t ugen20_kernel_driver_active; 85df4b8c2aSAndrew Thompson static libusb20_detach_kernel_driver_t ugen20_detach_kernel_driver; 86df4b8c2aSAndrew Thompson static libusb20_do_request_sync_t ugen20_do_request_sync; 87df4b8c2aSAndrew Thompson static libusb20_process_t ugen20_process; 88df4b8c2aSAndrew Thompson 89df4b8c2aSAndrew Thompson /* USB transfer specific */ 90df4b8c2aSAndrew Thompson static libusb20_tr_open_t ugen20_tr_open; 91df4b8c2aSAndrew Thompson static libusb20_tr_close_t ugen20_tr_close; 92df4b8c2aSAndrew Thompson static libusb20_tr_clear_stall_sync_t ugen20_tr_clear_stall_sync; 93df4b8c2aSAndrew Thompson static libusb20_tr_submit_t ugen20_tr_submit; 94df4b8c2aSAndrew Thompson static libusb20_tr_cancel_async_t ugen20_tr_cancel_async; 95df4b8c2aSAndrew Thompson 96df4b8c2aSAndrew Thompson static const struct libusb20_device_methods libusb20_ugen20_device_methods = { 97df4b8c2aSAndrew Thompson LIBUSB20_DEVICE(LIBUSB20_DECLARE, ugen20) 98df4b8c2aSAndrew Thompson }; 99df4b8c2aSAndrew Thompson 100df4b8c2aSAndrew Thompson static const char * 101df4b8c2aSAndrew Thompson ugen20_get_backend_name(void) 102df4b8c2aSAndrew Thompson { 103df4b8c2aSAndrew Thompson return ("FreeBSD UGEN 2.0"); 104df4b8c2aSAndrew Thompson } 105df4b8c2aSAndrew Thompson 106df4b8c2aSAndrew Thompson static uint32_t 107df4b8c2aSAndrew Thompson ugen20_path_convert_one(const char **pp) 108df4b8c2aSAndrew Thompson { 109df4b8c2aSAndrew Thompson const char *ptr; 110df4b8c2aSAndrew Thompson uint32_t temp = 0; 111df4b8c2aSAndrew Thompson 112df4b8c2aSAndrew Thompson ptr = *pp; 113df4b8c2aSAndrew Thompson 114df4b8c2aSAndrew Thompson while ((*ptr >= '0') && (*ptr <= '9')) { 115df4b8c2aSAndrew Thompson temp *= 10; 116df4b8c2aSAndrew Thompson temp += (*ptr - '0'); 117df4b8c2aSAndrew Thompson if (temp >= 1000000) { 118df4b8c2aSAndrew Thompson /* catch overflow early */ 119d81535d1SHans Petter Selasky return (0xFFFFFFFF); 120df4b8c2aSAndrew Thompson } 121df4b8c2aSAndrew Thompson ptr++; 122df4b8c2aSAndrew Thompson } 123df4b8c2aSAndrew Thompson 124df4b8c2aSAndrew Thompson if (*ptr == '.') { 125df4b8c2aSAndrew Thompson /* skip dot */ 126df4b8c2aSAndrew Thompson ptr++; 127df4b8c2aSAndrew Thompson } 128df4b8c2aSAndrew Thompson *pp = ptr; 129df4b8c2aSAndrew Thompson 130df4b8c2aSAndrew Thompson return (temp); 131df4b8c2aSAndrew Thompson } 132df4b8c2aSAndrew Thompson 133df4b8c2aSAndrew Thompson static int 134df4b8c2aSAndrew Thompson ugen20_enumerate(struct libusb20_device *pdev, const char *id) 135df4b8c2aSAndrew Thompson { 136df4b8c2aSAndrew Thompson const char *tmp = id; 137760bc48eSAndrew Thompson struct usb_device_descriptor ddesc; 138760bc48eSAndrew Thompson struct usb_device_info devinfo; 139fd2ef04fSHans Petter Selasky struct usb_device_port_path udpp; 140df4b8c2aSAndrew Thompson uint32_t plugtime; 141df4b8c2aSAndrew Thompson char buf[64]; 142df4b8c2aSAndrew Thompson int f; 143df4b8c2aSAndrew Thompson int error; 144df4b8c2aSAndrew Thompson 145df4b8c2aSAndrew Thompson pdev->bus_number = ugen20_path_convert_one(&tmp); 146df4b8c2aSAndrew Thompson pdev->device_address = ugen20_path_convert_one(&tmp); 147df4b8c2aSAndrew Thompson 148df4b8c2aSAndrew Thompson snprintf(buf, sizeof(buf), "/dev/" USB_GENERIC_NAME "%u.%u", 149df4b8c2aSAndrew Thompson pdev->bus_number, pdev->device_address); 150df4b8c2aSAndrew Thompson 151df4b8c2aSAndrew Thompson f = open(buf, O_RDWR); 152df4b8c2aSAndrew Thompson if (f < 0) { 153df4b8c2aSAndrew Thompson return (LIBUSB20_ERROR_OTHER); 154df4b8c2aSAndrew Thompson } 15599cd1f32SHans Petter Selasky if (ioctl(f, IOUSB(USB_GET_PLUGTIME), &plugtime)) { 156df4b8c2aSAndrew Thompson error = LIBUSB20_ERROR_OTHER; 157df4b8c2aSAndrew Thompson goto done; 158df4b8c2aSAndrew Thompson } 159df4b8c2aSAndrew Thompson /* store when the device was plugged */ 160df4b8c2aSAndrew Thompson pdev->session_data.plugtime = plugtime; 161df4b8c2aSAndrew Thompson 16299cd1f32SHans Petter Selasky if (ioctl(f, IOUSB(USB_GET_DEVICE_DESC), &ddesc)) { 163df4b8c2aSAndrew Thompson error = LIBUSB20_ERROR_OTHER; 164df4b8c2aSAndrew Thompson goto done; 165df4b8c2aSAndrew Thompson } 166df4b8c2aSAndrew Thompson LIBUSB20_INIT(LIBUSB20_DEVICE_DESC, &(pdev->ddesc)); 167df4b8c2aSAndrew Thompson 168df4b8c2aSAndrew Thompson libusb20_me_decode(&ddesc, sizeof(ddesc), &(pdev->ddesc)); 169df4b8c2aSAndrew Thompson 170df4b8c2aSAndrew Thompson if (pdev->ddesc.bNumConfigurations == 0) { 171df4b8c2aSAndrew Thompson error = LIBUSB20_ERROR_OTHER; 172df4b8c2aSAndrew Thompson goto done; 173df4b8c2aSAndrew Thompson } else if (pdev->ddesc.bNumConfigurations >= 8) { 174df4b8c2aSAndrew Thompson error = LIBUSB20_ERROR_OTHER; 175df4b8c2aSAndrew Thompson goto done; 176df4b8c2aSAndrew Thompson } 17799cd1f32SHans Petter Selasky if (ioctl(f, IOUSB(USB_GET_DEVICEINFO), &devinfo)) { 178df4b8c2aSAndrew Thompson error = LIBUSB20_ERROR_OTHER; 179df4b8c2aSAndrew Thompson goto done; 180df4b8c2aSAndrew Thompson } 181df4b8c2aSAndrew Thompson switch (devinfo.udi_mode) { 182df4b8c2aSAndrew Thompson case USB_MODE_DEVICE: 183df4b8c2aSAndrew Thompson pdev->usb_mode = LIBUSB20_MODE_DEVICE; 184df4b8c2aSAndrew Thompson break; 185df4b8c2aSAndrew Thompson default: 186df4b8c2aSAndrew Thompson pdev->usb_mode = LIBUSB20_MODE_HOST; 187df4b8c2aSAndrew Thompson break; 188df4b8c2aSAndrew Thompson } 189df4b8c2aSAndrew Thompson 190df4b8c2aSAndrew Thompson switch (devinfo.udi_speed) { 191df4b8c2aSAndrew Thompson case USB_SPEED_LOW: 192df4b8c2aSAndrew Thompson pdev->usb_speed = LIBUSB20_SPEED_LOW; 193df4b8c2aSAndrew Thompson break; 194df4b8c2aSAndrew Thompson case USB_SPEED_FULL: 195df4b8c2aSAndrew Thompson pdev->usb_speed = LIBUSB20_SPEED_FULL; 196df4b8c2aSAndrew Thompson break; 197df4b8c2aSAndrew Thompson case USB_SPEED_HIGH: 198df4b8c2aSAndrew Thompson pdev->usb_speed = LIBUSB20_SPEED_HIGH; 199df4b8c2aSAndrew Thompson break; 200df4b8c2aSAndrew Thompson case USB_SPEED_VARIABLE: 201df4b8c2aSAndrew Thompson pdev->usb_speed = LIBUSB20_SPEED_VARIABLE; 202df4b8c2aSAndrew Thompson break; 203df4b8c2aSAndrew Thompson case USB_SPEED_SUPER: 204df4b8c2aSAndrew Thompson pdev->usb_speed = LIBUSB20_SPEED_SUPER; 205df4b8c2aSAndrew Thompson break; 206df4b8c2aSAndrew Thompson default: 207df4b8c2aSAndrew Thompson pdev->usb_speed = LIBUSB20_SPEED_UNKNOWN; 208df4b8c2aSAndrew Thompson break; 209df4b8c2aSAndrew Thompson } 210df4b8c2aSAndrew Thompson 2112485d8a7SHans Petter Selasky /* get parent HUB index and port */ 2122485d8a7SHans Petter Selasky 2132485d8a7SHans Petter Selasky pdev->parent_address = devinfo.udi_hubindex; 2142485d8a7SHans Petter Selasky pdev->parent_port = devinfo.udi_hubport; 2152485d8a7SHans Petter Selasky 216df4b8c2aSAndrew Thompson /* generate a nice description for printout */ 217df4b8c2aSAndrew Thompson 218df4b8c2aSAndrew Thompson snprintf(pdev->usb_desc, sizeof(pdev->usb_desc), 219df4b8c2aSAndrew Thompson USB_GENERIC_NAME "%u.%u: <%s %s> at usbus%u", pdev->bus_number, 2200b9cf972SEdward Tomasz Napierala pdev->device_address, devinfo.udi_vendor, 2210b9cf972SEdward Tomasz Napierala devinfo.udi_product, pdev->bus_number); 222df4b8c2aSAndrew Thompson 223fd2ef04fSHans Petter Selasky /* get device port path, if any */ 224fd2ef04fSHans Petter Selasky if (ioctl(f, IOUSB(USB_GET_DEV_PORT_PATH), &udpp) == 0 && 225fd2ef04fSHans Petter Selasky udpp.udp_port_level < LIBUSB20_DEVICE_PORT_PATH_MAX) { 226fd2ef04fSHans Petter Selasky memcpy(pdev->port_path, udpp.udp_port_no, udpp.udp_port_level); 227fd2ef04fSHans Petter Selasky pdev->port_level = udpp.udp_port_level; 228fd2ef04fSHans Petter Selasky } 229fd2ef04fSHans Petter Selasky 230df4b8c2aSAndrew Thompson error = 0; 231df4b8c2aSAndrew Thompson done: 232df4b8c2aSAndrew Thompson close(f); 233df4b8c2aSAndrew Thompson return (error); 234df4b8c2aSAndrew Thompson } 235df4b8c2aSAndrew Thompson 236df4b8c2aSAndrew Thompson struct ugen20_urd_state { 237760bc48eSAndrew Thompson struct usb_read_dir urd; 238df4b8c2aSAndrew Thompson uint32_t nparsed; 239df4b8c2aSAndrew Thompson int f; 240df4b8c2aSAndrew Thompson uint8_t *ptr; 241df4b8c2aSAndrew Thompson const char *src; 242df4b8c2aSAndrew Thompson const char *dst; 243df4b8c2aSAndrew Thompson uint8_t buf[256]; 244df4b8c2aSAndrew Thompson uint8_t dummy_zero[1]; 245df4b8c2aSAndrew Thompson }; 246df4b8c2aSAndrew Thompson 247df4b8c2aSAndrew Thompson static int 248df4b8c2aSAndrew Thompson ugen20_readdir(struct ugen20_urd_state *st) 249df4b8c2aSAndrew Thompson { 250df4b8c2aSAndrew Thompson ; /* style fix */ 251df4b8c2aSAndrew Thompson repeat: 252df4b8c2aSAndrew Thompson if (st->ptr == NULL) { 253df4b8c2aSAndrew Thompson st->urd.urd_startentry += st->nparsed; 25451fd3d75SHans Petter Selasky st->urd.urd_data = libusb20_pass_ptr(st->buf); 255df4b8c2aSAndrew Thompson st->urd.urd_maxlen = sizeof(st->buf); 256df4b8c2aSAndrew Thompson st->nparsed = 0; 257df4b8c2aSAndrew Thompson 25899cd1f32SHans Petter Selasky if (ioctl(st->f, IOUSB(USB_READ_DIR), &st->urd)) { 259df4b8c2aSAndrew Thompson return (EINVAL); 260df4b8c2aSAndrew Thompson } 261df4b8c2aSAndrew Thompson st->ptr = st->buf; 262df4b8c2aSAndrew Thompson } 263df4b8c2aSAndrew Thompson if (st->ptr[0] == 0) { 264df4b8c2aSAndrew Thompson if (st->nparsed) { 265df4b8c2aSAndrew Thompson st->ptr = NULL; 266df4b8c2aSAndrew Thompson goto repeat; 267df4b8c2aSAndrew Thompson } else { 268df4b8c2aSAndrew Thompson return (ENXIO); 269df4b8c2aSAndrew Thompson } 270df4b8c2aSAndrew Thompson } 271df4b8c2aSAndrew Thompson st->src = (void *)(st->ptr + 1); 272df4b8c2aSAndrew Thompson st->dst = st->src + strlen(st->src) + 1; 273df4b8c2aSAndrew Thompson st->ptr = st->ptr + st->ptr[0]; 274df4b8c2aSAndrew Thompson st->nparsed++; 275df4b8c2aSAndrew Thompson 276df4b8c2aSAndrew Thompson if ((st->ptr < st->buf) || 277df4b8c2aSAndrew Thompson (st->ptr > st->dummy_zero)) { 278df4b8c2aSAndrew Thompson /* invalid entry */ 279df4b8c2aSAndrew Thompson return (EINVAL); 280df4b8c2aSAndrew Thompson } 281df4b8c2aSAndrew Thompson return (0); 282df4b8c2aSAndrew Thompson } 283df4b8c2aSAndrew Thompson 284df4b8c2aSAndrew Thompson static int 285df4b8c2aSAndrew Thompson ugen20_init_backend(struct libusb20_backend *pbe) 286df4b8c2aSAndrew Thompson { 287df4b8c2aSAndrew Thompson struct ugen20_urd_state state; 288df4b8c2aSAndrew Thompson struct libusb20_device *pdev; 289df4b8c2aSAndrew Thompson 290df4b8c2aSAndrew Thompson memset(&state, 0, sizeof(state)); 291df4b8c2aSAndrew Thompson 292df4b8c2aSAndrew Thompson state.f = open("/dev/" USB_DEVICE_NAME, O_RDONLY); 293df4b8c2aSAndrew Thompson if (state.f < 0) 294df4b8c2aSAndrew Thompson return (LIBUSB20_ERROR_OTHER); 295df4b8c2aSAndrew Thompson 296df4b8c2aSAndrew Thompson while (ugen20_readdir(&state) == 0) { 297df4b8c2aSAndrew Thompson 298df4b8c2aSAndrew Thompson if ((state.src[0] != 'u') || 299df4b8c2aSAndrew Thompson (state.src[1] != 'g') || 300df4b8c2aSAndrew Thompson (state.src[2] != 'e') || 301df4b8c2aSAndrew Thompson (state.src[3] != 'n')) { 302df4b8c2aSAndrew Thompson continue; 303df4b8c2aSAndrew Thompson } 304df4b8c2aSAndrew Thompson pdev = libusb20_dev_alloc(); 305df4b8c2aSAndrew Thompson if (pdev == NULL) { 306df4b8c2aSAndrew Thompson continue; 307df4b8c2aSAndrew Thompson } 308df4b8c2aSAndrew Thompson if (ugen20_enumerate(pdev, state.src + 4)) { 309df4b8c2aSAndrew Thompson libusb20_dev_free(pdev); 310df4b8c2aSAndrew Thompson continue; 311df4b8c2aSAndrew Thompson } 312df4b8c2aSAndrew Thompson /* put the device on the backend list */ 313df4b8c2aSAndrew Thompson libusb20_be_enqueue_device(pbe, pdev); 314df4b8c2aSAndrew Thompson } 315df4b8c2aSAndrew Thompson close(state.f); 316df4b8c2aSAndrew Thompson return (0); /* success */ 317df4b8c2aSAndrew Thompson } 318df4b8c2aSAndrew Thompson 319df4b8c2aSAndrew Thompson static void 320df4b8c2aSAndrew Thompson ugen20_tr_release(struct libusb20_device *pdev) 321df4b8c2aSAndrew Thompson { 322760bc48eSAndrew Thompson struct usb_fs_uninit fs_uninit; 323df4b8c2aSAndrew Thompson 324df4b8c2aSAndrew Thompson if (pdev->nTransfer == 0) { 325df4b8c2aSAndrew Thompson return; 326df4b8c2aSAndrew Thompson } 327df4b8c2aSAndrew Thompson /* release all pending USB transfers */ 328df4b8c2aSAndrew Thompson if (pdev->privBeData != NULL) { 329df4b8c2aSAndrew Thompson memset(&fs_uninit, 0, sizeof(fs_uninit)); 33099cd1f32SHans Petter Selasky if (ioctl(pdev->file, IOUSB(USB_FS_UNINIT), &fs_uninit)) { 331df4b8c2aSAndrew Thompson /* ignore any errors of this kind */ 332df4b8c2aSAndrew Thompson } 333df4b8c2aSAndrew Thompson } 334df4b8c2aSAndrew Thompson return; 335df4b8c2aSAndrew Thompson } 336df4b8c2aSAndrew Thompson 337df4b8c2aSAndrew Thompson static int 338df4b8c2aSAndrew Thompson ugen20_tr_renew(struct libusb20_device *pdev) 339df4b8c2aSAndrew Thompson { 340760bc48eSAndrew Thompson struct usb_fs_init fs_init; 341760bc48eSAndrew Thompson struct usb_fs_endpoint *pfse; 342df4b8c2aSAndrew Thompson int error; 343df4b8c2aSAndrew Thompson uint32_t size; 344df4b8c2aSAndrew Thompson uint16_t nMaxTransfer; 345df4b8c2aSAndrew Thompson 346df4b8c2aSAndrew Thompson nMaxTransfer = pdev->nTransfer; 347df4b8c2aSAndrew Thompson error = 0; 348df4b8c2aSAndrew Thompson 349df4b8c2aSAndrew Thompson if (nMaxTransfer == 0) { 350df4b8c2aSAndrew Thompson goto done; 351df4b8c2aSAndrew Thompson } 352df4b8c2aSAndrew Thompson size = nMaxTransfer * sizeof(*pfse); 353df4b8c2aSAndrew Thompson 354df4b8c2aSAndrew Thompson if (pdev->privBeData == NULL) { 355df4b8c2aSAndrew Thompson pfse = malloc(size); 356df4b8c2aSAndrew Thompson if (pfse == NULL) { 357df4b8c2aSAndrew Thompson error = LIBUSB20_ERROR_NO_MEM; 358df4b8c2aSAndrew Thompson goto done; 359df4b8c2aSAndrew Thompson } 360df4b8c2aSAndrew Thompson pdev->privBeData = pfse; 361df4b8c2aSAndrew Thompson } 362df4b8c2aSAndrew Thompson /* reset endpoint data */ 363df4b8c2aSAndrew Thompson memset(pdev->privBeData, 0, size); 364df4b8c2aSAndrew Thompson 365df4b8c2aSAndrew Thompson memset(&fs_init, 0, sizeof(fs_init)); 366df4b8c2aSAndrew Thompson 36751fd3d75SHans Petter Selasky fs_init.pEndpoints = libusb20_pass_ptr(pdev->privBeData); 368df4b8c2aSAndrew Thompson fs_init.ep_index_max = nMaxTransfer; 369df4b8c2aSAndrew Thompson 37099cd1f32SHans Petter Selasky if (ioctl(pdev->file, IOUSB(USB_FS_INIT), &fs_init)) { 371df4b8c2aSAndrew Thompson error = LIBUSB20_ERROR_OTHER; 372df4b8c2aSAndrew Thompson goto done; 373df4b8c2aSAndrew Thompson } 374df4b8c2aSAndrew Thompson done: 375df4b8c2aSAndrew Thompson return (error); 376df4b8c2aSAndrew Thompson } 377df4b8c2aSAndrew Thompson 378df4b8c2aSAndrew Thompson static int 379df4b8c2aSAndrew Thompson ugen20_open_device(struct libusb20_device *pdev, uint16_t nMaxTransfer) 380df4b8c2aSAndrew Thompson { 381df4b8c2aSAndrew Thompson uint32_t plugtime; 382df4b8c2aSAndrew Thompson char buf[64]; 383df4b8c2aSAndrew Thompson int f; 384df4b8c2aSAndrew Thompson int g; 385df4b8c2aSAndrew Thompson int error; 386df4b8c2aSAndrew Thompson 387df4b8c2aSAndrew Thompson snprintf(buf, sizeof(buf), "/dev/" USB_GENERIC_NAME "%u.%u", 388df4b8c2aSAndrew Thompson pdev->bus_number, pdev->device_address); 389df4b8c2aSAndrew Thompson 390df4b8c2aSAndrew Thompson /* 391df4b8c2aSAndrew Thompson * We need two file handles, one for the control endpoint and one 392df4b8c2aSAndrew Thompson * for BULK, INTERRUPT and ISOCHRONOUS transactions due to optimised 393df4b8c2aSAndrew Thompson * kernel locking. 394df4b8c2aSAndrew Thompson */ 395df4b8c2aSAndrew Thompson g = open(buf, O_RDWR); 396df4b8c2aSAndrew Thompson if (g < 0) { 397df4b8c2aSAndrew Thompson return (LIBUSB20_ERROR_NO_DEVICE); 398df4b8c2aSAndrew Thompson } 399df4b8c2aSAndrew Thompson f = open(buf, O_RDWR); 400df4b8c2aSAndrew Thompson if (f < 0) { 401df4b8c2aSAndrew Thompson close(g); 402df4b8c2aSAndrew Thompson return (LIBUSB20_ERROR_NO_DEVICE); 403df4b8c2aSAndrew Thompson } 40499cd1f32SHans Petter Selasky if (ioctl(f, IOUSB(USB_GET_PLUGTIME), &plugtime)) { 405df4b8c2aSAndrew Thompson error = LIBUSB20_ERROR_OTHER; 406df4b8c2aSAndrew Thompson goto done; 407df4b8c2aSAndrew Thompson } 408df4b8c2aSAndrew Thompson /* check that the correct device is still plugged */ 409df4b8c2aSAndrew Thompson if (pdev->session_data.plugtime != plugtime) { 410df4b8c2aSAndrew Thompson error = LIBUSB20_ERROR_NO_DEVICE; 411df4b8c2aSAndrew Thompson goto done; 412df4b8c2aSAndrew Thompson } 413df4b8c2aSAndrew Thompson /* need to set this before "tr_renew()" */ 414df4b8c2aSAndrew Thompson pdev->file = f; 415df4b8c2aSAndrew Thompson pdev->file_ctrl = g; 416df4b8c2aSAndrew Thompson 417df4b8c2aSAndrew Thompson /* renew all USB transfers */ 418df4b8c2aSAndrew Thompson error = ugen20_tr_renew(pdev); 419df4b8c2aSAndrew Thompson if (error) { 420df4b8c2aSAndrew Thompson goto done; 421df4b8c2aSAndrew Thompson } 422df4b8c2aSAndrew Thompson /* set methods */ 423df4b8c2aSAndrew Thompson pdev->methods = &libusb20_ugen20_device_methods; 424df4b8c2aSAndrew Thompson 425df4b8c2aSAndrew Thompson done: 426df4b8c2aSAndrew Thompson if (error) { 427df4b8c2aSAndrew Thompson if (pdev->privBeData) { 428df4b8c2aSAndrew Thompson /* cleanup after "tr_renew()" */ 429df4b8c2aSAndrew Thompson free(pdev->privBeData); 430df4b8c2aSAndrew Thompson pdev->privBeData = NULL; 431df4b8c2aSAndrew Thompson } 432df4b8c2aSAndrew Thompson pdev->file = -1; 433df4b8c2aSAndrew Thompson pdev->file_ctrl = -1; 434df4b8c2aSAndrew Thompson close(f); 435df4b8c2aSAndrew Thompson close(g); 436df4b8c2aSAndrew Thompson } 437df4b8c2aSAndrew Thompson return (error); 438df4b8c2aSAndrew Thompson } 439df4b8c2aSAndrew Thompson 440df4b8c2aSAndrew Thompson static int 441df4b8c2aSAndrew Thompson ugen20_close_device(struct libusb20_device *pdev) 442df4b8c2aSAndrew Thompson { 443760bc48eSAndrew Thompson struct usb_fs_uninit fs_uninit; 444df4b8c2aSAndrew Thompson 445df4b8c2aSAndrew Thompson if (pdev->privBeData) { 446df4b8c2aSAndrew Thompson memset(&fs_uninit, 0, sizeof(fs_uninit)); 44799cd1f32SHans Petter Selasky if (ioctl(pdev->file, IOUSB(USB_FS_UNINIT), &fs_uninit)) { 448df4b8c2aSAndrew Thompson /* ignore this error */ 449df4b8c2aSAndrew Thompson } 450df4b8c2aSAndrew Thompson free(pdev->privBeData); 451df4b8c2aSAndrew Thompson } 452df4b8c2aSAndrew Thompson pdev->nTransfer = 0; 453df4b8c2aSAndrew Thompson pdev->privBeData = NULL; 454df4b8c2aSAndrew Thompson close(pdev->file); 455df4b8c2aSAndrew Thompson close(pdev->file_ctrl); 456df4b8c2aSAndrew Thompson pdev->file = -1; 457df4b8c2aSAndrew Thompson pdev->file_ctrl = -1; 458df4b8c2aSAndrew Thompson return (0); /* success */ 459df4b8c2aSAndrew Thompson } 460df4b8c2aSAndrew Thompson 461df4b8c2aSAndrew Thompson static void 462df4b8c2aSAndrew Thompson ugen20_exit_backend(struct libusb20_backend *pbe) 463df4b8c2aSAndrew Thompson { 464df4b8c2aSAndrew Thompson return; /* nothing to do */ 465df4b8c2aSAndrew Thompson } 466df4b8c2aSAndrew Thompson 467df4b8c2aSAndrew Thompson static int 468df4b8c2aSAndrew Thompson ugen20_get_config_desc_full(struct libusb20_device *pdev, 469df4b8c2aSAndrew Thompson uint8_t **ppbuf, uint16_t *plen, uint8_t cfg_index) 470df4b8c2aSAndrew Thompson { 471760bc48eSAndrew Thompson struct usb_gen_descriptor gen_desc; 472760bc48eSAndrew Thompson struct usb_config_descriptor cdesc; 473df4b8c2aSAndrew Thompson uint8_t *ptr; 474df4b8c2aSAndrew Thompson uint16_t len; 475df4b8c2aSAndrew Thompson int error; 476df4b8c2aSAndrew Thompson 477ccef4ddfSAndrew Thompson /* make sure memory is initialised */ 478ccef4ddfSAndrew Thompson memset(&cdesc, 0, sizeof(cdesc)); 479df4b8c2aSAndrew Thompson memset(&gen_desc, 0, sizeof(gen_desc)); 480df4b8c2aSAndrew Thompson 48151fd3d75SHans Petter Selasky gen_desc.ugd_data = libusb20_pass_ptr(&cdesc); 482df4b8c2aSAndrew Thompson gen_desc.ugd_maxlen = sizeof(cdesc); 483df4b8c2aSAndrew Thompson gen_desc.ugd_config_index = cfg_index; 484df4b8c2aSAndrew Thompson 48599cd1f32SHans Petter Selasky error = ioctl(pdev->file_ctrl, IOUSB(USB_GET_FULL_DESC), &gen_desc); 486df4b8c2aSAndrew Thompson if (error) { 487df4b8c2aSAndrew Thompson return (LIBUSB20_ERROR_OTHER); 488df4b8c2aSAndrew Thompson } 489df4b8c2aSAndrew Thompson len = UGETW(cdesc.wTotalLength); 490df4b8c2aSAndrew Thompson if (len < sizeof(cdesc)) { 491df4b8c2aSAndrew Thompson /* corrupt descriptor */ 492df4b8c2aSAndrew Thompson return (LIBUSB20_ERROR_OTHER); 493df4b8c2aSAndrew Thompson } 494df4b8c2aSAndrew Thompson ptr = malloc(len); 495df4b8c2aSAndrew Thompson if (!ptr) { 496df4b8c2aSAndrew Thompson return (LIBUSB20_ERROR_NO_MEM); 497df4b8c2aSAndrew Thompson } 498ccef4ddfSAndrew Thompson 499ccef4ddfSAndrew Thompson /* make sure memory is initialised */ 500ccef4ddfSAndrew Thompson memset(ptr, 0, len); 501ccef4ddfSAndrew Thompson 50251fd3d75SHans Petter Selasky gen_desc.ugd_data = libusb20_pass_ptr(ptr); 503df4b8c2aSAndrew Thompson gen_desc.ugd_maxlen = len; 504df4b8c2aSAndrew Thompson 50599cd1f32SHans Petter Selasky error = ioctl(pdev->file_ctrl, IOUSB(USB_GET_FULL_DESC), &gen_desc); 506df4b8c2aSAndrew Thompson if (error) { 507df4b8c2aSAndrew Thompson free(ptr); 508df4b8c2aSAndrew Thompson return (LIBUSB20_ERROR_OTHER); 509df4b8c2aSAndrew Thompson } 510df4b8c2aSAndrew Thompson /* make sure that the device doesn't fool us */ 511df4b8c2aSAndrew Thompson memcpy(ptr, &cdesc, sizeof(cdesc)); 512df4b8c2aSAndrew Thompson 513df4b8c2aSAndrew Thompson *ppbuf = ptr; 514df4b8c2aSAndrew Thompson *plen = len; 515df4b8c2aSAndrew Thompson 516df4b8c2aSAndrew Thompson return (0); /* success */ 517df4b8c2aSAndrew Thompson } 518df4b8c2aSAndrew Thompson 519df4b8c2aSAndrew Thompson static int 520df4b8c2aSAndrew Thompson ugen20_get_config_index(struct libusb20_device *pdev, uint8_t *pindex) 521df4b8c2aSAndrew Thompson { 522df4b8c2aSAndrew Thompson int temp; 523df4b8c2aSAndrew Thompson 52499cd1f32SHans Petter Selasky if (ioctl(pdev->file_ctrl, IOUSB(USB_GET_CONFIG), &temp)) { 525df4b8c2aSAndrew Thompson return (LIBUSB20_ERROR_OTHER); 526df4b8c2aSAndrew Thompson } 527df4b8c2aSAndrew Thompson *pindex = temp; 528df4b8c2aSAndrew Thompson 529df4b8c2aSAndrew Thompson return (0); 530df4b8c2aSAndrew Thompson } 531df4b8c2aSAndrew Thompson 532df4b8c2aSAndrew Thompson static int 533df4b8c2aSAndrew Thompson ugen20_set_config_index(struct libusb20_device *pdev, uint8_t cfg_index) 534df4b8c2aSAndrew Thompson { 535df4b8c2aSAndrew Thompson int temp = cfg_index; 536df4b8c2aSAndrew Thompson 537df4b8c2aSAndrew Thompson /* release all active USB transfers */ 538df4b8c2aSAndrew Thompson ugen20_tr_release(pdev); 539df4b8c2aSAndrew Thompson 54099cd1f32SHans Petter Selasky if (ioctl(pdev->file_ctrl, IOUSB(USB_SET_CONFIG), &temp)) { 541df4b8c2aSAndrew Thompson return (LIBUSB20_ERROR_OTHER); 542df4b8c2aSAndrew Thompson } 543df4b8c2aSAndrew Thompson return (ugen20_tr_renew(pdev)); 544df4b8c2aSAndrew Thompson } 545df4b8c2aSAndrew Thompson 546df4b8c2aSAndrew Thompson static int 547df4b8c2aSAndrew Thompson ugen20_set_alt_index(struct libusb20_device *pdev, 548df4b8c2aSAndrew Thompson uint8_t iface_index, uint8_t alt_index) 549df4b8c2aSAndrew Thompson { 550760bc48eSAndrew Thompson struct usb_alt_interface alt_iface; 551df4b8c2aSAndrew Thompson 552df4b8c2aSAndrew Thompson memset(&alt_iface, 0, sizeof(alt_iface)); 553df4b8c2aSAndrew Thompson 554df4b8c2aSAndrew Thompson alt_iface.uai_interface_index = iface_index; 555df4b8c2aSAndrew Thompson alt_iface.uai_alt_index = alt_index; 556df4b8c2aSAndrew Thompson 557df4b8c2aSAndrew Thompson /* release all active USB transfers */ 558df4b8c2aSAndrew Thompson ugen20_tr_release(pdev); 559df4b8c2aSAndrew Thompson 56099cd1f32SHans Petter Selasky if (ioctl(pdev->file_ctrl, IOUSB(USB_SET_ALTINTERFACE), &alt_iface)) { 561df4b8c2aSAndrew Thompson return (LIBUSB20_ERROR_OTHER); 562df4b8c2aSAndrew Thompson } 563df4b8c2aSAndrew Thompson return (ugen20_tr_renew(pdev)); 564df4b8c2aSAndrew Thompson } 565df4b8c2aSAndrew Thompson 566df4b8c2aSAndrew Thompson static int 567df4b8c2aSAndrew Thompson ugen20_reset_device(struct libusb20_device *pdev) 568df4b8c2aSAndrew Thompson { 569df4b8c2aSAndrew Thompson int temp = 0; 570df4b8c2aSAndrew Thompson 571df4b8c2aSAndrew Thompson /* release all active USB transfers */ 572df4b8c2aSAndrew Thompson ugen20_tr_release(pdev); 573df4b8c2aSAndrew Thompson 57499cd1f32SHans Petter Selasky if (ioctl(pdev->file_ctrl, IOUSB(USB_DEVICEENUMERATE), &temp)) { 575df4b8c2aSAndrew Thompson return (LIBUSB20_ERROR_OTHER); 576df4b8c2aSAndrew Thompson } 577df4b8c2aSAndrew Thompson return (ugen20_tr_renew(pdev)); 578df4b8c2aSAndrew Thompson } 579df4b8c2aSAndrew Thompson 580df4b8c2aSAndrew Thompson static int 581e50ac68bSAndrew Thompson ugen20_check_connected(struct libusb20_device *pdev) 582e50ac68bSAndrew Thompson { 583e50ac68bSAndrew Thompson uint32_t plugtime; 584e50ac68bSAndrew Thompson int error = 0; 585e50ac68bSAndrew Thompson 58699cd1f32SHans Petter Selasky if (ioctl(pdev->file_ctrl, IOUSB(USB_GET_PLUGTIME), &plugtime)) { 587e50ac68bSAndrew Thompson error = LIBUSB20_ERROR_NO_DEVICE; 588e50ac68bSAndrew Thompson goto done; 589e50ac68bSAndrew Thompson } 590e50ac68bSAndrew Thompson 591e50ac68bSAndrew Thompson if (pdev->session_data.plugtime != plugtime) { 592e50ac68bSAndrew Thompson error = LIBUSB20_ERROR_NO_DEVICE; 593e50ac68bSAndrew Thompson goto done; 594e50ac68bSAndrew Thompson } 595e50ac68bSAndrew Thompson done: 596e50ac68bSAndrew Thompson return (error); 597e50ac68bSAndrew Thompson } 598e50ac68bSAndrew Thompson 599e50ac68bSAndrew Thompson static int 600df4b8c2aSAndrew Thompson ugen20_set_power_mode(struct libusb20_device *pdev, uint8_t power_mode) 601df4b8c2aSAndrew Thompson { 602df4b8c2aSAndrew Thompson int temp; 603df4b8c2aSAndrew Thompson 604df4b8c2aSAndrew Thompson switch (power_mode) { 605df4b8c2aSAndrew Thompson case LIBUSB20_POWER_OFF: 606df4b8c2aSAndrew Thompson temp = USB_POWER_MODE_OFF; 607df4b8c2aSAndrew Thompson break; 608df4b8c2aSAndrew Thompson case LIBUSB20_POWER_ON: 609df4b8c2aSAndrew Thompson temp = USB_POWER_MODE_ON; 610df4b8c2aSAndrew Thompson break; 611df4b8c2aSAndrew Thompson case LIBUSB20_POWER_SAVE: 612df4b8c2aSAndrew Thompson temp = USB_POWER_MODE_SAVE; 613df4b8c2aSAndrew Thompson break; 614df4b8c2aSAndrew Thompson case LIBUSB20_POWER_SUSPEND: 615df4b8c2aSAndrew Thompson temp = USB_POWER_MODE_SUSPEND; 616df4b8c2aSAndrew Thompson break; 617df4b8c2aSAndrew Thompson case LIBUSB20_POWER_RESUME: 618df4b8c2aSAndrew Thompson temp = USB_POWER_MODE_RESUME; 619df4b8c2aSAndrew Thompson break; 620df4b8c2aSAndrew Thompson default: 621df4b8c2aSAndrew Thompson return (LIBUSB20_ERROR_INVALID_PARAM); 622df4b8c2aSAndrew Thompson } 62399cd1f32SHans Petter Selasky if (ioctl(pdev->file_ctrl, IOUSB(USB_SET_POWER_MODE), &temp)) { 624df4b8c2aSAndrew Thompson return (LIBUSB20_ERROR_OTHER); 625df4b8c2aSAndrew Thompson } 626df4b8c2aSAndrew Thompson return (0); 627df4b8c2aSAndrew Thompson } 628df4b8c2aSAndrew Thompson 629df4b8c2aSAndrew Thompson static int 630df4b8c2aSAndrew Thompson ugen20_get_power_mode(struct libusb20_device *pdev, uint8_t *power_mode) 631df4b8c2aSAndrew Thompson { 632df4b8c2aSAndrew Thompson int temp; 633df4b8c2aSAndrew Thompson 63499cd1f32SHans Petter Selasky if (ioctl(pdev->file_ctrl, IOUSB(USB_GET_POWER_MODE), &temp)) { 635df4b8c2aSAndrew Thompson return (LIBUSB20_ERROR_OTHER); 636df4b8c2aSAndrew Thompson } 637df4b8c2aSAndrew Thompson switch (temp) { 638df4b8c2aSAndrew Thompson case USB_POWER_MODE_OFF: 639df4b8c2aSAndrew Thompson temp = LIBUSB20_POWER_OFF; 640df4b8c2aSAndrew Thompson break; 641df4b8c2aSAndrew Thompson case USB_POWER_MODE_ON: 642df4b8c2aSAndrew Thompson temp = LIBUSB20_POWER_ON; 643df4b8c2aSAndrew Thompson break; 644df4b8c2aSAndrew Thompson case USB_POWER_MODE_SAVE: 645df4b8c2aSAndrew Thompson temp = LIBUSB20_POWER_SAVE; 646df4b8c2aSAndrew Thompson break; 647df4b8c2aSAndrew Thompson case USB_POWER_MODE_SUSPEND: 648df4b8c2aSAndrew Thompson temp = LIBUSB20_POWER_SUSPEND; 649df4b8c2aSAndrew Thompson break; 650df4b8c2aSAndrew Thompson case USB_POWER_MODE_RESUME: 651df4b8c2aSAndrew Thompson temp = LIBUSB20_POWER_RESUME; 652df4b8c2aSAndrew Thompson break; 653df4b8c2aSAndrew Thompson default: 654df4b8c2aSAndrew Thompson temp = LIBUSB20_POWER_ON; 655df4b8c2aSAndrew Thompson break; 656df4b8c2aSAndrew Thompson } 657df4b8c2aSAndrew Thompson *power_mode = temp; 658df4b8c2aSAndrew Thompson return (0); /* success */ 659df4b8c2aSAndrew Thompson } 660df4b8c2aSAndrew Thompson 661df4b8c2aSAndrew Thompson static int 662aafcb732SHans Petter Selasky ugen20_get_power_usage(struct libusb20_device *pdev, uint16_t *power_usage) 663aafcb732SHans Petter Selasky { 664aafcb732SHans Petter Selasky int temp; 665aafcb732SHans Petter Selasky 66699cd1f32SHans Petter Selasky if (ioctl(pdev->file_ctrl, IOUSB(USB_GET_POWER_USAGE), &temp)) { 667aafcb732SHans Petter Selasky return (LIBUSB20_ERROR_OTHER); 668aafcb732SHans Petter Selasky } 669aafcb732SHans Petter Selasky *power_usage = temp; 670aafcb732SHans Petter Selasky return (0); /* success */ 671aafcb732SHans Petter Selasky } 672aafcb732SHans Petter Selasky 673aafcb732SHans Petter Selasky static int 674*34b0ca24SHans Petter Selasky ugen20_get_stats(struct libusb20_device *pdev, struct libusb20_device_stats *pstats) 675*34b0ca24SHans Petter Selasky { 676*34b0ca24SHans Petter Selasky struct usb_device_stats st; 677*34b0ca24SHans Petter Selasky 678*34b0ca24SHans Petter Selasky if (ioctl(pdev->file_ctrl, IOUSB(USB_DEVICESTATS), &st)) 679*34b0ca24SHans Petter Selasky return (LIBUSB20_ERROR_OTHER); 680*34b0ca24SHans Petter Selasky 681*34b0ca24SHans Petter Selasky memset(pstats, 0, sizeof(*pstats)); 682*34b0ca24SHans Petter Selasky 683*34b0ca24SHans Petter Selasky pstats->xfer_ok[0] = st.uds_requests_ok[0]; 684*34b0ca24SHans Petter Selasky pstats->xfer_ok[1] = st.uds_requests_ok[1]; 685*34b0ca24SHans Petter Selasky pstats->xfer_ok[2] = st.uds_requests_ok[2]; 686*34b0ca24SHans Petter Selasky pstats->xfer_ok[3] = st.uds_requests_ok[3]; 687*34b0ca24SHans Petter Selasky 688*34b0ca24SHans Petter Selasky pstats->xfer_fail[0] = st.uds_requests_fail[0]; 689*34b0ca24SHans Petter Selasky pstats->xfer_fail[1] = st.uds_requests_fail[1]; 690*34b0ca24SHans Petter Selasky pstats->xfer_fail[2] = st.uds_requests_fail[2]; 691*34b0ca24SHans Petter Selasky pstats->xfer_fail[3] = st.uds_requests_fail[3]; 692*34b0ca24SHans Petter Selasky 693*34b0ca24SHans Petter Selasky return (0); /* success */ 694*34b0ca24SHans Petter Selasky } 695*34b0ca24SHans Petter Selasky 696*34b0ca24SHans Petter Selasky static int 697df4b8c2aSAndrew Thompson ugen20_kernel_driver_active(struct libusb20_device *pdev, 698df4b8c2aSAndrew Thompson uint8_t iface_index) 699df4b8c2aSAndrew Thompson { 700df4b8c2aSAndrew Thompson int temp = iface_index; 701df4b8c2aSAndrew Thompson 70299cd1f32SHans Petter Selasky if (ioctl(pdev->file_ctrl, IOUSB(USB_IFACE_DRIVER_ACTIVE), &temp)) { 703df4b8c2aSAndrew Thompson return (LIBUSB20_ERROR_OTHER); 704df4b8c2aSAndrew Thompson } 705df4b8c2aSAndrew Thompson return (0); /* kernel driver is active */ 706df4b8c2aSAndrew Thompson } 707df4b8c2aSAndrew Thompson 708df4b8c2aSAndrew Thompson static int 709df4b8c2aSAndrew Thompson ugen20_detach_kernel_driver(struct libusb20_device *pdev, 710df4b8c2aSAndrew Thompson uint8_t iface_index) 711df4b8c2aSAndrew Thompson { 712df4b8c2aSAndrew Thompson int temp = iface_index; 713df4b8c2aSAndrew Thompson 71499cd1f32SHans Petter Selasky if (ioctl(pdev->file_ctrl, IOUSB(USB_IFACE_DRIVER_DETACH), &temp)) { 715df4b8c2aSAndrew Thompson return (LIBUSB20_ERROR_OTHER); 716df4b8c2aSAndrew Thompson } 7175122043eSHans Petter Selasky return (0); /* kernel driver is detached */ 718df4b8c2aSAndrew Thompson } 719df4b8c2aSAndrew Thompson 720df4b8c2aSAndrew Thompson static int 721df4b8c2aSAndrew Thompson ugen20_do_request_sync(struct libusb20_device *pdev, 722df4b8c2aSAndrew Thompson struct LIBUSB20_CONTROL_SETUP_DECODED *setup, 723df4b8c2aSAndrew Thompson void *data, uint16_t *pactlen, uint32_t timeout, uint8_t flags) 724df4b8c2aSAndrew Thompson { 725760bc48eSAndrew Thompson struct usb_ctl_request req; 726df4b8c2aSAndrew Thompson 727df4b8c2aSAndrew Thompson memset(&req, 0, sizeof(req)); 728df4b8c2aSAndrew Thompson 72951fd3d75SHans Petter Selasky req.ucr_data = libusb20_pass_ptr(data); 730df4b8c2aSAndrew Thompson if (!(flags & LIBUSB20_TRANSFER_SINGLE_SHORT_NOT_OK)) { 731df4b8c2aSAndrew Thompson req.ucr_flags |= USB_SHORT_XFER_OK; 732df4b8c2aSAndrew Thompson } 733df4b8c2aSAndrew Thompson if (libusb20_me_encode(&req.ucr_request, 734df4b8c2aSAndrew Thompson sizeof(req.ucr_request), setup)) { 735df4b8c2aSAndrew Thompson /* ignore */ 736df4b8c2aSAndrew Thompson } 73799cd1f32SHans Petter Selasky if (ioctl(pdev->file_ctrl, IOUSB(USB_DO_REQUEST), &req)) { 738df4b8c2aSAndrew Thompson return (LIBUSB20_ERROR_OTHER); 739df4b8c2aSAndrew Thompson } 740df4b8c2aSAndrew Thompson if (pactlen) { 741df4b8c2aSAndrew Thompson /* get actual length */ 742df4b8c2aSAndrew Thompson *pactlen = req.ucr_actlen; 743df4b8c2aSAndrew Thompson } 7445122043eSHans Petter Selasky return (0); /* request was successful */ 745df4b8c2aSAndrew Thompson } 746df4b8c2aSAndrew Thompson 747df4b8c2aSAndrew Thompson static int 748df4b8c2aSAndrew Thompson ugen20_process(struct libusb20_device *pdev) 749df4b8c2aSAndrew Thompson { 750760bc48eSAndrew Thompson struct usb_fs_complete temp; 751760bc48eSAndrew Thompson struct usb_fs_endpoint *fsep; 752df4b8c2aSAndrew Thompson struct libusb20_transfer *xfer; 753df4b8c2aSAndrew Thompson 754df4b8c2aSAndrew Thompson while (1) { 755df4b8c2aSAndrew Thompson 75699cd1f32SHans Petter Selasky if (ioctl(pdev->file, IOUSB(USB_FS_COMPLETE), &temp)) { 757df4b8c2aSAndrew Thompson if (errno == EBUSY) { 758df4b8c2aSAndrew Thompson break; 759df4b8c2aSAndrew Thompson } else { 760df4b8c2aSAndrew Thompson /* device detached */ 761df4b8c2aSAndrew Thompson return (LIBUSB20_ERROR_OTHER); 762df4b8c2aSAndrew Thompson } 763df4b8c2aSAndrew Thompson } 764df4b8c2aSAndrew Thompson fsep = pdev->privBeData; 765df4b8c2aSAndrew Thompson xfer = pdev->pTransfer; 766df4b8c2aSAndrew Thompson fsep += temp.ep_index; 767df4b8c2aSAndrew Thompson xfer += temp.ep_index; 768df4b8c2aSAndrew Thompson 769df4b8c2aSAndrew Thompson /* update transfer status */ 770df4b8c2aSAndrew Thompson 771df4b8c2aSAndrew Thompson if (fsep->status == 0) { 772df4b8c2aSAndrew Thompson xfer->aFrames = fsep->aFrames; 773df4b8c2aSAndrew Thompson xfer->timeComplete = fsep->isoc_time_complete; 774df4b8c2aSAndrew Thompson xfer->status = LIBUSB20_TRANSFER_COMPLETED; 775df4b8c2aSAndrew Thompson } else if (fsep->status == USB_ERR_CANCELLED) { 776df4b8c2aSAndrew Thompson xfer->aFrames = 0; 777df4b8c2aSAndrew Thompson xfer->timeComplete = 0; 778df4b8c2aSAndrew Thompson xfer->status = LIBUSB20_TRANSFER_CANCELLED; 779df4b8c2aSAndrew Thompson } else if (fsep->status == USB_ERR_STALLED) { 780df4b8c2aSAndrew Thompson xfer->aFrames = 0; 781df4b8c2aSAndrew Thompson xfer->timeComplete = 0; 782df4b8c2aSAndrew Thompson xfer->status = LIBUSB20_TRANSFER_STALL; 783df4b8c2aSAndrew Thompson } else if (fsep->status == USB_ERR_TIMEOUT) { 784df4b8c2aSAndrew Thompson xfer->aFrames = 0; 785df4b8c2aSAndrew Thompson xfer->timeComplete = 0; 786df4b8c2aSAndrew Thompson xfer->status = LIBUSB20_TRANSFER_TIMED_OUT; 787df4b8c2aSAndrew Thompson } else { 788df4b8c2aSAndrew Thompson xfer->aFrames = 0; 789df4b8c2aSAndrew Thompson xfer->timeComplete = 0; 790df4b8c2aSAndrew Thompson xfer->status = LIBUSB20_TRANSFER_ERROR; 791df4b8c2aSAndrew Thompson } 792df4b8c2aSAndrew Thompson libusb20_tr_callback_wrapper(xfer); 793df4b8c2aSAndrew Thompson } 794df4b8c2aSAndrew Thompson return (0); /* done */ 795df4b8c2aSAndrew Thompson } 796df4b8c2aSAndrew Thompson 797df4b8c2aSAndrew Thompson static int 798df4b8c2aSAndrew Thompson ugen20_tr_open(struct libusb20_transfer *xfer, uint32_t MaxBufSize, 79907b6ce3bSHans Petter Selasky uint32_t MaxFrameCount, uint8_t ep_no, uint16_t stream_id, 80007b6ce3bSHans Petter Selasky uint8_t pre_scale) 801df4b8c2aSAndrew Thompson { 80207b6ce3bSHans Petter Selasky union { 80307b6ce3bSHans Petter Selasky struct usb_fs_open fs_open; 80407b6ce3bSHans Petter Selasky struct usb_fs_open_stream fs_open_stream; 80507b6ce3bSHans Petter Selasky } temp; 806760bc48eSAndrew Thompson struct usb_fs_endpoint *fsep; 807df4b8c2aSAndrew Thompson 8081c497368SHans Petter Selasky if (pre_scale) 8091c497368SHans Petter Selasky MaxFrameCount |= USB_FS_MAX_FRAMES_PRE_SCALE; 8101c497368SHans Petter Selasky 811df4b8c2aSAndrew Thompson memset(&temp, 0, sizeof(temp)); 812df4b8c2aSAndrew Thompson 813df4b8c2aSAndrew Thompson fsep = xfer->pdev->privBeData; 814df4b8c2aSAndrew Thompson fsep += xfer->trIndex; 815df4b8c2aSAndrew Thompson 81607b6ce3bSHans Petter Selasky temp.fs_open.max_bufsize = MaxBufSize; 81707b6ce3bSHans Petter Selasky temp.fs_open.max_frames = MaxFrameCount; 81807b6ce3bSHans Petter Selasky temp.fs_open.ep_index = xfer->trIndex; 81907b6ce3bSHans Petter Selasky temp.fs_open.ep_no = ep_no; 820df4b8c2aSAndrew Thompson 82107b6ce3bSHans Petter Selasky if (stream_id != 0) { 82207b6ce3bSHans Petter Selasky temp.fs_open_stream.stream_id = stream_id; 82307b6ce3bSHans Petter Selasky 82499cd1f32SHans Petter Selasky if (ioctl(xfer->pdev->file, IOUSB(USB_FS_OPEN_STREAM), &temp.fs_open_stream)) 82507b6ce3bSHans Petter Selasky return (LIBUSB20_ERROR_INVALID_PARAM); 82607b6ce3bSHans Petter Selasky } else { 82799cd1f32SHans Petter Selasky if (ioctl(xfer->pdev->file, IOUSB(USB_FS_OPEN), &temp.fs_open)) 828df4b8c2aSAndrew Thompson return (LIBUSB20_ERROR_INVALID_PARAM); 829df4b8c2aSAndrew Thompson } 830df4b8c2aSAndrew Thompson /* maximums might have changed - update */ 83107b6ce3bSHans Petter Selasky xfer->maxFrames = temp.fs_open.max_frames; 832df4b8c2aSAndrew Thompson 833df4b8c2aSAndrew Thompson /* "max_bufsize" should be multiple of "max_packet_length" */ 83407b6ce3bSHans Petter Selasky xfer->maxTotalLength = temp.fs_open.max_bufsize; 83507b6ce3bSHans Petter Selasky xfer->maxPacketLen = temp.fs_open.max_packet_length; 836df4b8c2aSAndrew Thompson 83751fd3d75SHans Petter Selasky /* setup buffer and length lists using zero copy */ 83851fd3d75SHans Petter Selasky fsep->ppBuffer = libusb20_pass_ptr(xfer->ppBuffer); 83951fd3d75SHans Petter Selasky fsep->pLength = libusb20_pass_ptr(xfer->pLength); 840df4b8c2aSAndrew Thompson 841df4b8c2aSAndrew Thompson return (0); /* success */ 842df4b8c2aSAndrew Thompson } 843df4b8c2aSAndrew Thompson 844df4b8c2aSAndrew Thompson static int 845df4b8c2aSAndrew Thompson ugen20_tr_close(struct libusb20_transfer *xfer) 846df4b8c2aSAndrew Thompson { 847760bc48eSAndrew Thompson struct usb_fs_close temp; 848df4b8c2aSAndrew Thompson 849df4b8c2aSAndrew Thompson memset(&temp, 0, sizeof(temp)); 850df4b8c2aSAndrew Thompson 851df4b8c2aSAndrew Thompson temp.ep_index = xfer->trIndex; 852df4b8c2aSAndrew Thompson 85399cd1f32SHans Petter Selasky if (ioctl(xfer->pdev->file, IOUSB(USB_FS_CLOSE), &temp)) { 854df4b8c2aSAndrew Thompson return (LIBUSB20_ERROR_INVALID_PARAM); 855df4b8c2aSAndrew Thompson } 856df4b8c2aSAndrew Thompson return (0); /* success */ 857df4b8c2aSAndrew Thompson } 858df4b8c2aSAndrew Thompson 859df4b8c2aSAndrew Thompson static int 860df4b8c2aSAndrew Thompson ugen20_tr_clear_stall_sync(struct libusb20_transfer *xfer) 861df4b8c2aSAndrew Thompson { 862760bc48eSAndrew Thompson struct usb_fs_clear_stall_sync temp; 863df4b8c2aSAndrew Thompson 864df4b8c2aSAndrew Thompson memset(&temp, 0, sizeof(temp)); 865df4b8c2aSAndrew Thompson 866df4b8c2aSAndrew Thompson /* if the transfer is active, an error will be returned */ 867df4b8c2aSAndrew Thompson 868df4b8c2aSAndrew Thompson temp.ep_index = xfer->trIndex; 869df4b8c2aSAndrew Thompson 87099cd1f32SHans Petter Selasky if (ioctl(xfer->pdev->file, IOUSB(USB_FS_CLEAR_STALL_SYNC), &temp)) { 871df4b8c2aSAndrew Thompson return (LIBUSB20_ERROR_INVALID_PARAM); 872df4b8c2aSAndrew Thompson } 873df4b8c2aSAndrew Thompson return (0); /* success */ 874df4b8c2aSAndrew Thompson } 875df4b8c2aSAndrew Thompson 876df4b8c2aSAndrew Thompson static void 877df4b8c2aSAndrew Thompson ugen20_tr_submit(struct libusb20_transfer *xfer) 878df4b8c2aSAndrew Thompson { 879760bc48eSAndrew Thompson struct usb_fs_start temp; 880760bc48eSAndrew Thompson struct usb_fs_endpoint *fsep; 881df4b8c2aSAndrew Thompson 882df4b8c2aSAndrew Thompson memset(&temp, 0, sizeof(temp)); 883df4b8c2aSAndrew Thompson 884df4b8c2aSAndrew Thompson fsep = xfer->pdev->privBeData; 885df4b8c2aSAndrew Thompson fsep += xfer->trIndex; 886df4b8c2aSAndrew Thompson 887df4b8c2aSAndrew Thompson fsep->nFrames = xfer->nFrames; 888df4b8c2aSAndrew Thompson fsep->flags = 0; 889df4b8c2aSAndrew Thompson if (!(xfer->flags & LIBUSB20_TRANSFER_SINGLE_SHORT_NOT_OK)) { 890df4b8c2aSAndrew Thompson fsep->flags |= USB_FS_FLAG_SINGLE_SHORT_OK; 891df4b8c2aSAndrew Thompson } 892df4b8c2aSAndrew Thompson if (!(xfer->flags & LIBUSB20_TRANSFER_MULTI_SHORT_NOT_OK)) { 893df4b8c2aSAndrew Thompson fsep->flags |= USB_FS_FLAG_MULTI_SHORT_OK; 894df4b8c2aSAndrew Thompson } 895df4b8c2aSAndrew Thompson if (xfer->flags & LIBUSB20_TRANSFER_FORCE_SHORT) { 896df4b8c2aSAndrew Thompson fsep->flags |= USB_FS_FLAG_FORCE_SHORT; 897df4b8c2aSAndrew Thompson } 898df4b8c2aSAndrew Thompson if (xfer->flags & LIBUSB20_TRANSFER_DO_CLEAR_STALL) { 899df4b8c2aSAndrew Thompson fsep->flags |= USB_FS_FLAG_CLEAR_STALL; 900df4b8c2aSAndrew Thompson } 9010c35eaadSAndrew Thompson /* NOTE: The "fsep->timeout" variable is 16-bit. */ 9020c35eaadSAndrew Thompson if (xfer->timeout > 65535) 9030c35eaadSAndrew Thompson fsep->timeout = 65535; 9040c35eaadSAndrew Thompson else 905df4b8c2aSAndrew Thompson fsep->timeout = xfer->timeout; 906df4b8c2aSAndrew Thompson 907df4b8c2aSAndrew Thompson temp.ep_index = xfer->trIndex; 908df4b8c2aSAndrew Thompson 90999cd1f32SHans Petter Selasky if (ioctl(xfer->pdev->file, IOUSB(USB_FS_START), &temp)) { 910df4b8c2aSAndrew Thompson /* ignore any errors - should never happen */ 911df4b8c2aSAndrew Thompson } 912df4b8c2aSAndrew Thompson return; /* success */ 913df4b8c2aSAndrew Thompson } 914df4b8c2aSAndrew Thompson 915df4b8c2aSAndrew Thompson static void 916df4b8c2aSAndrew Thompson ugen20_tr_cancel_async(struct libusb20_transfer *xfer) 917df4b8c2aSAndrew Thompson { 918760bc48eSAndrew Thompson struct usb_fs_stop temp; 919df4b8c2aSAndrew Thompson 920df4b8c2aSAndrew Thompson memset(&temp, 0, sizeof(temp)); 921df4b8c2aSAndrew Thompson 922df4b8c2aSAndrew Thompson temp.ep_index = xfer->trIndex; 923df4b8c2aSAndrew Thompson 92499cd1f32SHans Petter Selasky if (ioctl(xfer->pdev->file, IOUSB(USB_FS_STOP), &temp)) { 925df4b8c2aSAndrew Thompson /* ignore any errors - should never happen */ 926df4b8c2aSAndrew Thompson } 927df4b8c2aSAndrew Thompson return; 928df4b8c2aSAndrew Thompson } 929df4b8c2aSAndrew Thompson 930df4b8c2aSAndrew Thompson static int 931df4b8c2aSAndrew Thompson ugen20_be_ioctl(uint32_t cmd, void *data) 932df4b8c2aSAndrew Thompson { 933df4b8c2aSAndrew Thompson int f; 934df4b8c2aSAndrew Thompson int error; 935df4b8c2aSAndrew Thompson 936df4b8c2aSAndrew Thompson f = open("/dev/" USB_DEVICE_NAME, O_RDONLY); 937df4b8c2aSAndrew Thompson if (f < 0) 938df4b8c2aSAndrew Thompson return (LIBUSB20_ERROR_OTHER); 939df4b8c2aSAndrew Thompson error = ioctl(f, cmd, data); 940df4b8c2aSAndrew Thompson if (error == -1) { 941df4b8c2aSAndrew Thompson if (errno == EPERM) { 942df4b8c2aSAndrew Thompson error = LIBUSB20_ERROR_ACCESS; 943df4b8c2aSAndrew Thompson } else { 944df4b8c2aSAndrew Thompson error = LIBUSB20_ERROR_OTHER; 945df4b8c2aSAndrew Thompson } 946df4b8c2aSAndrew Thompson } 947df4b8c2aSAndrew Thompson close(f); 948df4b8c2aSAndrew Thompson return (error); 949df4b8c2aSAndrew Thompson } 950df4b8c2aSAndrew Thompson 951df4b8c2aSAndrew Thompson static int 952df4b8c2aSAndrew Thompson ugen20_dev_get_iface_desc(struct libusb20_device *pdev, 953df4b8c2aSAndrew Thompson uint8_t iface_index, char *buf, uint8_t len) 954df4b8c2aSAndrew Thompson { 955760bc48eSAndrew Thompson struct usb_gen_descriptor ugd; 956df4b8c2aSAndrew Thompson 957df4b8c2aSAndrew Thompson memset(&ugd, 0, sizeof(ugd)); 958df4b8c2aSAndrew Thompson 95951fd3d75SHans Petter Selasky ugd.ugd_data = libusb20_pass_ptr(buf); 960df4b8c2aSAndrew Thompson ugd.ugd_maxlen = len; 961df4b8c2aSAndrew Thompson ugd.ugd_iface_index = iface_index; 962df4b8c2aSAndrew Thompson 96399cd1f32SHans Petter Selasky if (ioctl(pdev->file, IOUSB(USB_GET_IFACE_DRIVER), &ugd)) { 964df4b8c2aSAndrew Thompson return (LIBUSB20_ERROR_INVALID_PARAM); 965df4b8c2aSAndrew Thompson } 966df4b8c2aSAndrew Thompson return (0); 967df4b8c2aSAndrew Thompson } 968df4b8c2aSAndrew Thompson 969df4b8c2aSAndrew Thompson static int 970df4b8c2aSAndrew Thompson ugen20_dev_get_info(struct libusb20_device *pdev, 971760bc48eSAndrew Thompson struct usb_device_info *pinfo) 972df4b8c2aSAndrew Thompson { 97399cd1f32SHans Petter Selasky if (ioctl(pdev->file, IOUSB(USB_GET_DEVICEINFO), pinfo)) { 974df4b8c2aSAndrew Thompson return (LIBUSB20_ERROR_INVALID_PARAM); 975df4b8c2aSAndrew Thompson } 976df4b8c2aSAndrew Thompson return (0); 977df4b8c2aSAndrew Thompson } 978df4b8c2aSAndrew Thompson 979df4b8c2aSAndrew Thompson static int 980df4b8c2aSAndrew Thompson ugen20_root_get_dev_quirk(struct libusb20_backend *pbe, 981df4b8c2aSAndrew Thompson uint16_t quirk_index, struct libusb20_quirk *pq) 982df4b8c2aSAndrew Thompson { 983760bc48eSAndrew Thompson struct usb_gen_quirk q; 984df4b8c2aSAndrew Thompson int error; 985df4b8c2aSAndrew Thompson 986df4b8c2aSAndrew Thompson memset(&q, 0, sizeof(q)); 987df4b8c2aSAndrew Thompson 988df4b8c2aSAndrew Thompson q.index = quirk_index; 989df4b8c2aSAndrew Thompson 99099cd1f32SHans Petter Selasky error = ugen20_be_ioctl(IOUSB(USB_DEV_QUIRK_GET), &q); 991df4b8c2aSAndrew Thompson 992df4b8c2aSAndrew Thompson if (error) { 993df4b8c2aSAndrew Thompson if (errno == EINVAL) { 994df4b8c2aSAndrew Thompson return (LIBUSB20_ERROR_NOT_FOUND); 995df4b8c2aSAndrew Thompson } 996df4b8c2aSAndrew Thompson } else { 997df4b8c2aSAndrew Thompson pq->vid = q.vid; 998df4b8c2aSAndrew Thompson pq->pid = q.pid; 999df4b8c2aSAndrew Thompson pq->bcdDeviceLow = q.bcdDeviceLow; 1000df4b8c2aSAndrew Thompson pq->bcdDeviceHigh = q.bcdDeviceHigh; 1001df4b8c2aSAndrew Thompson strlcpy(pq->quirkname, q.quirkname, sizeof(pq->quirkname)); 1002df4b8c2aSAndrew Thompson } 1003df4b8c2aSAndrew Thompson return (error); 1004df4b8c2aSAndrew Thompson } 1005df4b8c2aSAndrew Thompson 1006df4b8c2aSAndrew Thompson static int 1007df4b8c2aSAndrew Thompson ugen20_root_get_quirk_name(struct libusb20_backend *pbe, uint16_t quirk_index, 1008df4b8c2aSAndrew Thompson struct libusb20_quirk *pq) 1009df4b8c2aSAndrew Thompson { 1010760bc48eSAndrew Thompson struct usb_gen_quirk q; 1011df4b8c2aSAndrew Thompson int error; 1012df4b8c2aSAndrew Thompson 1013df4b8c2aSAndrew Thompson memset(&q, 0, sizeof(q)); 1014df4b8c2aSAndrew Thompson 1015df4b8c2aSAndrew Thompson q.index = quirk_index; 1016df4b8c2aSAndrew Thompson 101799cd1f32SHans Petter Selasky error = ugen20_be_ioctl(IOUSB(USB_QUIRK_NAME_GET), &q); 1018df4b8c2aSAndrew Thompson 1019df4b8c2aSAndrew Thompson if (error) { 1020df4b8c2aSAndrew Thompson if (errno == EINVAL) { 1021df4b8c2aSAndrew Thompson return (LIBUSB20_ERROR_NOT_FOUND); 1022df4b8c2aSAndrew Thompson } 1023df4b8c2aSAndrew Thompson } else { 1024df4b8c2aSAndrew Thompson strlcpy(pq->quirkname, q.quirkname, sizeof(pq->quirkname)); 1025df4b8c2aSAndrew Thompson } 1026df4b8c2aSAndrew Thompson return (error); 1027df4b8c2aSAndrew Thompson } 1028df4b8c2aSAndrew Thompson 1029df4b8c2aSAndrew Thompson static int 1030df4b8c2aSAndrew Thompson ugen20_root_add_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_ADD), &q); 1045df4b8c2aSAndrew Thompson if (error) { 1046df4b8c2aSAndrew Thompson if (errno == ENOMEM) { 1047df4b8c2aSAndrew Thompson return (LIBUSB20_ERROR_NO_MEM); 1048df4b8c2aSAndrew Thompson } 1049df4b8c2aSAndrew Thompson } 1050df4b8c2aSAndrew Thompson return (error); 1051df4b8c2aSAndrew Thompson } 1052df4b8c2aSAndrew Thompson 1053df4b8c2aSAndrew Thompson static int 1054df4b8c2aSAndrew Thompson ugen20_root_remove_dev_quirk(struct libusb20_backend *pbe, 1055df4b8c2aSAndrew Thompson struct libusb20_quirk *pq) 1056df4b8c2aSAndrew Thompson { 1057760bc48eSAndrew Thompson struct usb_gen_quirk q; 1058df4b8c2aSAndrew Thompson int error; 1059df4b8c2aSAndrew Thompson 1060df4b8c2aSAndrew Thompson memset(&q, 0, sizeof(q)); 1061df4b8c2aSAndrew Thompson 1062df4b8c2aSAndrew Thompson q.vid = pq->vid; 1063df4b8c2aSAndrew Thompson q.pid = pq->pid; 1064df4b8c2aSAndrew Thompson q.bcdDeviceLow = pq->bcdDeviceLow; 1065df4b8c2aSAndrew Thompson q.bcdDeviceHigh = pq->bcdDeviceHigh; 1066df4b8c2aSAndrew Thompson strlcpy(q.quirkname, pq->quirkname, sizeof(q.quirkname)); 1067df4b8c2aSAndrew Thompson 106899cd1f32SHans Petter Selasky error = ugen20_be_ioctl(IOUSB(USB_DEV_QUIRK_REMOVE), &q); 1069df4b8c2aSAndrew Thompson if (error) { 1070df4b8c2aSAndrew Thompson if (errno == EINVAL) { 1071df4b8c2aSAndrew Thompson return (LIBUSB20_ERROR_NOT_FOUND); 1072df4b8c2aSAndrew Thompson } 1073df4b8c2aSAndrew Thompson } 1074df4b8c2aSAndrew Thompson return (error); 1075df4b8c2aSAndrew Thompson } 1076df4b8c2aSAndrew Thompson 1077df4b8c2aSAndrew Thompson static int 1078df4b8c2aSAndrew Thompson ugen20_root_set_template(struct libusb20_backend *pbe, int temp) 1079df4b8c2aSAndrew Thompson { 108099cd1f32SHans Petter Selasky return (ugen20_be_ioctl(IOUSB(USB_SET_TEMPLATE), &temp)); 1081df4b8c2aSAndrew Thompson } 1082df4b8c2aSAndrew Thompson 1083df4b8c2aSAndrew Thompson static int 1084df4b8c2aSAndrew Thompson ugen20_root_get_template(struct libusb20_backend *pbe, int *ptemp) 1085df4b8c2aSAndrew Thompson { 108699cd1f32SHans Petter Selasky return (ugen20_be_ioctl(IOUSB(USB_GET_TEMPLATE), ptemp)); 1087df4b8c2aSAndrew Thompson } 1088