1df4b8c2aSAndrew Thompson /* $FreeBSD$ */ 2df4b8c2aSAndrew Thompson /*- 3df4b8c2aSAndrew Thompson * Copyright (c) 2008 Hans Petter Selasky. All rights reserved. 4df4b8c2aSAndrew Thompson * 5df4b8c2aSAndrew Thompson * Redistribution and use in source and binary forms, with or without 6df4b8c2aSAndrew Thompson * modification, are permitted provided that the following conditions 7df4b8c2aSAndrew Thompson * are met: 8df4b8c2aSAndrew Thompson * 1. Redistributions of source code must retain the above copyright 9df4b8c2aSAndrew Thompson * notice, this list of conditions and the following disclaimer. 10df4b8c2aSAndrew Thompson * 2. Redistributions in binary form must reproduce the above copyright 11df4b8c2aSAndrew Thompson * notice, this list of conditions and the following disclaimer in the 12df4b8c2aSAndrew Thompson * documentation and/or other materials provided with the distribution. 13df4b8c2aSAndrew Thompson * 14df4b8c2aSAndrew Thompson * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND 15df4b8c2aSAndrew Thompson * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 16df4b8c2aSAndrew Thompson * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 17df4b8c2aSAndrew Thompson * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE 18df4b8c2aSAndrew Thompson * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 19df4b8c2aSAndrew Thompson * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 20df4b8c2aSAndrew Thompson * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 21df4b8c2aSAndrew Thompson * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 22df4b8c2aSAndrew Thompson * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 23df4b8c2aSAndrew Thompson * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 24df4b8c2aSAndrew Thompson * SUCH DAMAGE. 25df4b8c2aSAndrew Thompson */ 26df4b8c2aSAndrew Thompson 27df4b8c2aSAndrew Thompson #include <stdio.h> 28df4b8c2aSAndrew Thompson #include <stdlib.h> 29df4b8c2aSAndrew Thompson #include <string.h> 30df4b8c2aSAndrew Thompson #include <poll.h> 31df4b8c2aSAndrew Thompson #include <ctype.h> 32df4b8c2aSAndrew Thompson #include <sys/queue.h> 33df4b8c2aSAndrew Thompson 34df4b8c2aSAndrew Thompson #include "libusb20.h" 35df4b8c2aSAndrew Thompson #include "libusb20_desc.h" 36df4b8c2aSAndrew Thompson #include "libusb20_int.h" 37df4b8c2aSAndrew Thompson 38df4b8c2aSAndrew Thompson static int 39df4b8c2aSAndrew Thompson dummy_int(void) 40df4b8c2aSAndrew Thompson { 41df4b8c2aSAndrew Thompson return (LIBUSB20_ERROR_NOT_SUPPORTED); 42df4b8c2aSAndrew Thompson } 43df4b8c2aSAndrew Thompson 44df4b8c2aSAndrew Thompson static void 45df4b8c2aSAndrew Thompson dummy_void(void) 46df4b8c2aSAndrew Thompson { 47df4b8c2aSAndrew Thompson return; 48df4b8c2aSAndrew Thompson } 49df4b8c2aSAndrew Thompson 50df4b8c2aSAndrew Thompson static void 51df4b8c2aSAndrew Thompson dummy_callback(struct libusb20_transfer *xfer) 52df4b8c2aSAndrew Thompson { 53df4b8c2aSAndrew Thompson ; /* style fix */ 54df4b8c2aSAndrew Thompson switch (libusb20_tr_get_status(xfer)) { 55df4b8c2aSAndrew Thompson case LIBUSB20_TRANSFER_START: 56df4b8c2aSAndrew Thompson libusb20_tr_submit(xfer); 57df4b8c2aSAndrew Thompson break; 58df4b8c2aSAndrew Thompson default: 59df4b8c2aSAndrew Thompson /* complete or error */ 60df4b8c2aSAndrew Thompson break; 61df4b8c2aSAndrew Thompson } 62df4b8c2aSAndrew Thompson return; 63df4b8c2aSAndrew Thompson } 64df4b8c2aSAndrew Thompson 65df4b8c2aSAndrew Thompson #define dummy_get_config_desc_full (void *)dummy_int 66df4b8c2aSAndrew Thompson #define dummy_get_config_index (void *)dummy_int 67df4b8c2aSAndrew Thompson #define dummy_set_config_index (void *)dummy_int 68df4b8c2aSAndrew Thompson #define dummy_claim_interface (void *)dummy_int 69df4b8c2aSAndrew Thompson #define dummy_release_interface (void *)dummy_int 70df4b8c2aSAndrew Thompson #define dummy_set_alt_index (void *)dummy_int 71df4b8c2aSAndrew Thompson #define dummy_reset_device (void *)dummy_int 72df4b8c2aSAndrew Thompson #define dummy_set_power_mode (void *)dummy_int 73df4b8c2aSAndrew Thompson #define dummy_get_power_mode (void *)dummy_int 74df4b8c2aSAndrew Thompson #define dummy_kernel_driver_active (void *)dummy_int 75df4b8c2aSAndrew Thompson #define dummy_detach_kernel_driver (void *)dummy_int 76df4b8c2aSAndrew Thompson #define dummy_do_request_sync (void *)dummy_int 77df4b8c2aSAndrew Thompson #define dummy_tr_open (void *)dummy_int 78df4b8c2aSAndrew Thompson #define dummy_tr_close (void *)dummy_int 79df4b8c2aSAndrew Thompson #define dummy_tr_clear_stall_sync (void *)dummy_int 80df4b8c2aSAndrew Thompson #define dummy_process (void *)dummy_int 81df4b8c2aSAndrew Thompson #define dummy_dev_info (void *)dummy_int 82df4b8c2aSAndrew Thompson #define dummy_dev_get_iface_driver (void *)dummy_int 83df4b8c2aSAndrew Thompson 84df4b8c2aSAndrew Thompson #define dummy_tr_submit (void *)dummy_void 85df4b8c2aSAndrew Thompson #define dummy_tr_cancel_async (void *)dummy_void 86df4b8c2aSAndrew Thompson 87df4b8c2aSAndrew Thompson static const struct libusb20_device_methods libusb20_dummy_methods = { 88df4b8c2aSAndrew Thompson LIBUSB20_DEVICE(LIBUSB20_DECLARE, dummy) 89df4b8c2aSAndrew Thompson }; 90df4b8c2aSAndrew Thompson 91df4b8c2aSAndrew Thompson void 92df4b8c2aSAndrew Thompson libusb20_tr_callback_wrapper(struct libusb20_transfer *xfer) 93df4b8c2aSAndrew Thompson { 94df4b8c2aSAndrew Thompson ; /* style fix */ 95df4b8c2aSAndrew Thompson 96df4b8c2aSAndrew Thompson repeat: 97df4b8c2aSAndrew Thompson 98df4b8c2aSAndrew Thompson if (!xfer->is_pending) { 99df4b8c2aSAndrew Thompson xfer->status = LIBUSB20_TRANSFER_START; 100df4b8c2aSAndrew Thompson } else { 101df4b8c2aSAndrew Thompson xfer->is_pending = 0; 102df4b8c2aSAndrew Thompson } 103df4b8c2aSAndrew Thompson 104df4b8c2aSAndrew Thompson xfer->callback(xfer); 105df4b8c2aSAndrew Thompson 106df4b8c2aSAndrew Thompson if (xfer->is_restart) { 107df4b8c2aSAndrew Thompson xfer->is_restart = 0; 108df4b8c2aSAndrew Thompson goto repeat; 109df4b8c2aSAndrew Thompson } 110df4b8c2aSAndrew Thompson if (xfer->is_draining && 111df4b8c2aSAndrew Thompson (!xfer->is_pending)) { 112df4b8c2aSAndrew Thompson xfer->is_draining = 0; 113df4b8c2aSAndrew Thompson xfer->status = LIBUSB20_TRANSFER_DRAINED; 114df4b8c2aSAndrew Thompson xfer->callback(xfer); 115df4b8c2aSAndrew Thompson } 116df4b8c2aSAndrew Thompson return; 117df4b8c2aSAndrew Thompson } 118df4b8c2aSAndrew Thompson 119df4b8c2aSAndrew Thompson int 120df4b8c2aSAndrew Thompson libusb20_tr_close(struct libusb20_transfer *xfer) 121df4b8c2aSAndrew Thompson { 122df4b8c2aSAndrew Thompson int error; 123df4b8c2aSAndrew Thompson 124df4b8c2aSAndrew Thompson if (!xfer->is_opened) { 125df4b8c2aSAndrew Thompson return (LIBUSB20_ERROR_OTHER); 126df4b8c2aSAndrew Thompson } 127df4b8c2aSAndrew Thompson error = xfer->pdev->methods->tr_close(xfer); 128df4b8c2aSAndrew Thompson 129df4b8c2aSAndrew Thompson if (xfer->pLength) { 130df4b8c2aSAndrew Thompson free(xfer->pLength); 131df4b8c2aSAndrew Thompson } 132df4b8c2aSAndrew Thompson if (xfer->ppBuffer) { 133df4b8c2aSAndrew Thompson free(xfer->ppBuffer); 134df4b8c2aSAndrew Thompson } 135df4b8c2aSAndrew Thompson /* clear some fields */ 136df4b8c2aSAndrew Thompson xfer->is_opened = 0; 137df4b8c2aSAndrew Thompson xfer->maxFrames = 0; 138df4b8c2aSAndrew Thompson xfer->maxTotalLength = 0; 139df4b8c2aSAndrew Thompson xfer->maxPacketLen = 0; 140df4b8c2aSAndrew Thompson return (error); 141df4b8c2aSAndrew Thompson } 142df4b8c2aSAndrew Thompson 143df4b8c2aSAndrew Thompson int 144df4b8c2aSAndrew Thompson libusb20_tr_open(struct libusb20_transfer *xfer, uint32_t MaxBufSize, 145df4b8c2aSAndrew Thompson uint32_t MaxFrameCount, uint8_t ep_no) 146df4b8c2aSAndrew Thompson { 147df4b8c2aSAndrew Thompson uint32_t size; 148df4b8c2aSAndrew Thompson int error; 149df4b8c2aSAndrew Thompson 150df4b8c2aSAndrew Thompson if (xfer->is_opened) { 151df4b8c2aSAndrew Thompson return (LIBUSB20_ERROR_BUSY); 152df4b8c2aSAndrew Thompson } 153df4b8c2aSAndrew Thompson if (MaxFrameCount == 0) { 154df4b8c2aSAndrew Thompson return (LIBUSB20_ERROR_INVALID_PARAM); 155df4b8c2aSAndrew Thompson } 156df4b8c2aSAndrew Thompson xfer->maxFrames = MaxFrameCount; 157df4b8c2aSAndrew Thompson 158df4b8c2aSAndrew Thompson size = MaxFrameCount * sizeof(xfer->pLength[0]); 159df4b8c2aSAndrew Thompson xfer->pLength = malloc(size); 160df4b8c2aSAndrew Thompson if (xfer->pLength == NULL) { 161df4b8c2aSAndrew Thompson return (LIBUSB20_ERROR_NO_MEM); 162df4b8c2aSAndrew Thompson } 163df4b8c2aSAndrew Thompson memset(xfer->pLength, 0, size); 164df4b8c2aSAndrew Thompson 165df4b8c2aSAndrew Thompson size = MaxFrameCount * sizeof(xfer->ppBuffer[0]); 166df4b8c2aSAndrew Thompson xfer->ppBuffer = malloc(size); 167df4b8c2aSAndrew Thompson if (xfer->ppBuffer == NULL) { 168df4b8c2aSAndrew Thompson free(xfer->pLength); 169df4b8c2aSAndrew Thompson return (LIBUSB20_ERROR_NO_MEM); 170df4b8c2aSAndrew Thompson } 171df4b8c2aSAndrew Thompson memset(xfer->ppBuffer, 0, size); 172df4b8c2aSAndrew Thompson 173df4b8c2aSAndrew Thompson error = xfer->pdev->methods->tr_open(xfer, MaxBufSize, 174df4b8c2aSAndrew Thompson MaxFrameCount, ep_no); 175df4b8c2aSAndrew Thompson 176df4b8c2aSAndrew Thompson if (error) { 177df4b8c2aSAndrew Thompson free(xfer->ppBuffer); 178df4b8c2aSAndrew Thompson free(xfer->pLength); 179df4b8c2aSAndrew Thompson } else { 180df4b8c2aSAndrew Thompson xfer->is_opened = 1; 181df4b8c2aSAndrew Thompson } 182df4b8c2aSAndrew Thompson return (error); 183df4b8c2aSAndrew Thompson } 184df4b8c2aSAndrew Thompson 185df4b8c2aSAndrew Thompson struct libusb20_transfer * 186df4b8c2aSAndrew Thompson libusb20_tr_get_pointer(struct libusb20_device *pdev, uint16_t trIndex) 187df4b8c2aSAndrew Thompson { 188df4b8c2aSAndrew Thompson if (trIndex >= pdev->nTransfer) { 189df4b8c2aSAndrew Thompson return (NULL); 190df4b8c2aSAndrew Thompson } 191df4b8c2aSAndrew Thompson return (pdev->pTransfer + trIndex); 192df4b8c2aSAndrew Thompson } 193df4b8c2aSAndrew Thompson 194df4b8c2aSAndrew Thompson uint32_t 195df4b8c2aSAndrew Thompson libusb20_tr_get_actual_frames(struct libusb20_transfer *xfer) 196df4b8c2aSAndrew Thompson { 197df4b8c2aSAndrew Thompson return (xfer->aFrames); 198df4b8c2aSAndrew Thompson } 199df4b8c2aSAndrew Thompson 200df4b8c2aSAndrew Thompson uint16_t 201df4b8c2aSAndrew Thompson libusb20_tr_get_time_complete(struct libusb20_transfer *xfer) 202df4b8c2aSAndrew Thompson { 203df4b8c2aSAndrew Thompson return (xfer->timeComplete); 204df4b8c2aSAndrew Thompson } 205df4b8c2aSAndrew Thompson 206df4b8c2aSAndrew Thompson uint32_t 207df4b8c2aSAndrew Thompson libusb20_tr_get_actual_length(struct libusb20_transfer *xfer) 208df4b8c2aSAndrew Thompson { 209df4b8c2aSAndrew Thompson uint32_t x; 210df4b8c2aSAndrew Thompson uint32_t actlen = 0; 211df4b8c2aSAndrew Thompson 212df4b8c2aSAndrew Thompson for (x = 0; x != xfer->aFrames; x++) { 213df4b8c2aSAndrew Thompson actlen += xfer->pLength[x]; 214df4b8c2aSAndrew Thompson } 215df4b8c2aSAndrew Thompson return (actlen); 216df4b8c2aSAndrew Thompson } 217df4b8c2aSAndrew Thompson 218df4b8c2aSAndrew Thompson uint32_t 219df4b8c2aSAndrew Thompson libusb20_tr_get_max_frames(struct libusb20_transfer *xfer) 220df4b8c2aSAndrew Thompson { 221df4b8c2aSAndrew Thompson return (xfer->maxFrames); 222df4b8c2aSAndrew Thompson } 223df4b8c2aSAndrew Thompson 224df4b8c2aSAndrew Thompson uint32_t 225df4b8c2aSAndrew Thompson libusb20_tr_get_max_packet_length(struct libusb20_transfer *xfer) 226df4b8c2aSAndrew Thompson { 227df4b8c2aSAndrew Thompson /* 228df4b8c2aSAndrew Thompson * Special Case NOTE: If the packet multiplier is non-zero for 229df4b8c2aSAndrew Thompson * High Speed USB, the value returned is equal to 230df4b8c2aSAndrew Thompson * "wMaxPacketSize * multiplier" ! 231df4b8c2aSAndrew Thompson */ 232df4b8c2aSAndrew Thompson return (xfer->maxPacketLen); 233df4b8c2aSAndrew Thompson } 234df4b8c2aSAndrew Thompson 235df4b8c2aSAndrew Thompson uint32_t 236df4b8c2aSAndrew Thompson libusb20_tr_get_max_total_length(struct libusb20_transfer *xfer) 237df4b8c2aSAndrew Thompson { 238df4b8c2aSAndrew Thompson return (xfer->maxTotalLength); 239df4b8c2aSAndrew Thompson } 240df4b8c2aSAndrew Thompson 241df4b8c2aSAndrew Thompson uint8_t 242df4b8c2aSAndrew Thompson libusb20_tr_get_status(struct libusb20_transfer *xfer) 243df4b8c2aSAndrew Thompson { 244df4b8c2aSAndrew Thompson return (xfer->status); 245df4b8c2aSAndrew Thompson } 246df4b8c2aSAndrew Thompson 247df4b8c2aSAndrew Thompson uint8_t 248df4b8c2aSAndrew Thompson libusb20_tr_pending(struct libusb20_transfer *xfer) 249df4b8c2aSAndrew Thompson { 250df4b8c2aSAndrew Thompson return (xfer->is_pending); 251df4b8c2aSAndrew Thompson } 252df4b8c2aSAndrew Thompson 253df4b8c2aSAndrew Thompson void * 254df4b8c2aSAndrew Thompson libusb20_tr_get_priv_sc0(struct libusb20_transfer *xfer) 255df4b8c2aSAndrew Thompson { 256df4b8c2aSAndrew Thompson return (xfer->priv_sc0); 257df4b8c2aSAndrew Thompson } 258df4b8c2aSAndrew Thompson 259df4b8c2aSAndrew Thompson void * 260df4b8c2aSAndrew Thompson libusb20_tr_get_priv_sc1(struct libusb20_transfer *xfer) 261df4b8c2aSAndrew Thompson { 262df4b8c2aSAndrew Thompson return (xfer->priv_sc1); 263df4b8c2aSAndrew Thompson } 264df4b8c2aSAndrew Thompson 265df4b8c2aSAndrew Thompson void 266df4b8c2aSAndrew Thompson libusb20_tr_stop(struct libusb20_transfer *xfer) 267df4b8c2aSAndrew Thompson { 268df4b8c2aSAndrew Thompson if (!xfer->is_pending) { 269df4b8c2aSAndrew Thompson /* transfer not pending */ 270df4b8c2aSAndrew Thompson return; 271df4b8c2aSAndrew Thompson } 272df4b8c2aSAndrew Thompson if (xfer->is_cancel) { 273df4b8c2aSAndrew Thompson /* already cancelling */ 274df4b8c2aSAndrew Thompson return; 275df4b8c2aSAndrew Thompson } 276df4b8c2aSAndrew Thompson xfer->is_cancel = 1; /* we are cancelling */ 277df4b8c2aSAndrew Thompson 278df4b8c2aSAndrew Thompson xfer->pdev->methods->tr_cancel_async(xfer); 279df4b8c2aSAndrew Thompson return; 280df4b8c2aSAndrew Thompson } 281df4b8c2aSAndrew Thompson 282df4b8c2aSAndrew Thompson void 283df4b8c2aSAndrew Thompson libusb20_tr_drain(struct libusb20_transfer *xfer) 284df4b8c2aSAndrew Thompson { 285df4b8c2aSAndrew Thompson /* make sure that we are cancelling */ 286df4b8c2aSAndrew Thompson libusb20_tr_stop(xfer); 287df4b8c2aSAndrew Thompson 288df4b8c2aSAndrew Thompson if (xfer->is_pending) { 289df4b8c2aSAndrew Thompson xfer->is_draining = 1; 290df4b8c2aSAndrew Thompson } 291df4b8c2aSAndrew Thompson return; 292df4b8c2aSAndrew Thompson } 293df4b8c2aSAndrew Thompson 294df4b8c2aSAndrew Thompson void 295df4b8c2aSAndrew Thompson libusb20_tr_clear_stall_sync(struct libusb20_transfer *xfer) 296df4b8c2aSAndrew Thompson { 297df4b8c2aSAndrew Thompson xfer->pdev->methods->tr_clear_stall_sync(xfer); 298df4b8c2aSAndrew Thompson return; 299df4b8c2aSAndrew Thompson } 300df4b8c2aSAndrew Thompson 301df4b8c2aSAndrew Thompson void 302df4b8c2aSAndrew Thompson libusb20_tr_set_buffer(struct libusb20_transfer *xfer, void *buffer, uint16_t frIndex) 303df4b8c2aSAndrew Thompson { 304df4b8c2aSAndrew Thompson xfer->ppBuffer[frIndex] = buffer; 305df4b8c2aSAndrew Thompson return; 306df4b8c2aSAndrew Thompson } 307df4b8c2aSAndrew Thompson 308df4b8c2aSAndrew Thompson void 309df4b8c2aSAndrew Thompson libusb20_tr_set_callback(struct libusb20_transfer *xfer, libusb20_tr_callback_t *cb) 310df4b8c2aSAndrew Thompson { 311df4b8c2aSAndrew Thompson xfer->callback = cb; 312df4b8c2aSAndrew Thompson return; 313df4b8c2aSAndrew Thompson } 314df4b8c2aSAndrew Thompson 315df4b8c2aSAndrew Thompson void 316df4b8c2aSAndrew Thompson libusb20_tr_set_flags(struct libusb20_transfer *xfer, uint8_t flags) 317df4b8c2aSAndrew Thompson { 318df4b8c2aSAndrew Thompson xfer->flags = flags; 319df4b8c2aSAndrew Thompson return; 320df4b8c2aSAndrew Thompson } 321df4b8c2aSAndrew Thompson 322df4b8c2aSAndrew Thompson void 323df4b8c2aSAndrew Thompson libusb20_tr_set_length(struct libusb20_transfer *xfer, uint32_t length, uint16_t frIndex) 324df4b8c2aSAndrew Thompson { 325df4b8c2aSAndrew Thompson xfer->pLength[frIndex] = length; 326df4b8c2aSAndrew Thompson return; 327df4b8c2aSAndrew Thompson } 328df4b8c2aSAndrew Thompson 329df4b8c2aSAndrew Thompson void 330df4b8c2aSAndrew Thompson libusb20_tr_set_priv_sc0(struct libusb20_transfer *xfer, void *sc0) 331df4b8c2aSAndrew Thompson { 332df4b8c2aSAndrew Thompson xfer->priv_sc0 = sc0; 333df4b8c2aSAndrew Thompson return; 334df4b8c2aSAndrew Thompson } 335df4b8c2aSAndrew Thompson 336df4b8c2aSAndrew Thompson void 337df4b8c2aSAndrew Thompson libusb20_tr_set_priv_sc1(struct libusb20_transfer *xfer, void *sc1) 338df4b8c2aSAndrew Thompson { 339df4b8c2aSAndrew Thompson xfer->priv_sc1 = sc1; 340df4b8c2aSAndrew Thompson return; 341df4b8c2aSAndrew Thompson } 342df4b8c2aSAndrew Thompson 343df4b8c2aSAndrew Thompson void 344df4b8c2aSAndrew Thompson libusb20_tr_set_timeout(struct libusb20_transfer *xfer, uint32_t timeout) 345df4b8c2aSAndrew Thompson { 346df4b8c2aSAndrew Thompson xfer->timeout = timeout; 347df4b8c2aSAndrew Thompson return; 348df4b8c2aSAndrew Thompson } 349df4b8c2aSAndrew Thompson 350df4b8c2aSAndrew Thompson void 351df4b8c2aSAndrew Thompson libusb20_tr_set_total_frames(struct libusb20_transfer *xfer, uint32_t nFrames) 352df4b8c2aSAndrew Thompson { 353df4b8c2aSAndrew Thompson if (nFrames > xfer->maxFrames) { 354df4b8c2aSAndrew Thompson /* should not happen */ 355df4b8c2aSAndrew Thompson nFrames = xfer->maxFrames; 356df4b8c2aSAndrew Thompson } 357df4b8c2aSAndrew Thompson xfer->nFrames = nFrames; 358df4b8c2aSAndrew Thompson return; 359df4b8c2aSAndrew Thompson } 360df4b8c2aSAndrew Thompson 361df4b8c2aSAndrew Thompson void 362df4b8c2aSAndrew Thompson libusb20_tr_setup_bulk(struct libusb20_transfer *xfer, void *pBuf, uint32_t length, uint32_t timeout) 363df4b8c2aSAndrew Thompson { 364df4b8c2aSAndrew Thompson xfer->ppBuffer[0] = pBuf; 365df4b8c2aSAndrew Thompson xfer->pLength[0] = length; 366df4b8c2aSAndrew Thompson xfer->timeout = timeout; 367df4b8c2aSAndrew Thompson xfer->nFrames = 1; 368df4b8c2aSAndrew Thompson return; 369df4b8c2aSAndrew Thompson } 370df4b8c2aSAndrew Thompson 371df4b8c2aSAndrew Thompson void 372df4b8c2aSAndrew Thompson libusb20_tr_setup_control(struct libusb20_transfer *xfer, void *psetup, void *pBuf, uint32_t timeout) 373df4b8c2aSAndrew Thompson { 374df4b8c2aSAndrew Thompson uint16_t len; 375df4b8c2aSAndrew Thompson 376df4b8c2aSAndrew Thompson xfer->ppBuffer[0] = psetup; 377df4b8c2aSAndrew Thompson xfer->pLength[0] = 8; /* fixed */ 378df4b8c2aSAndrew Thompson xfer->timeout = timeout; 379df4b8c2aSAndrew Thompson 380df4b8c2aSAndrew Thompson len = ((uint8_t *)psetup)[6] | (((uint8_t *)psetup)[7] << 8); 381df4b8c2aSAndrew Thompson 382df4b8c2aSAndrew Thompson if (len != 0) { 383df4b8c2aSAndrew Thompson xfer->nFrames = 2; 384df4b8c2aSAndrew Thompson xfer->ppBuffer[1] = pBuf; 385df4b8c2aSAndrew Thompson xfer->pLength[1] = len; 386df4b8c2aSAndrew Thompson } else { 387df4b8c2aSAndrew Thompson xfer->nFrames = 1; 388df4b8c2aSAndrew Thompson } 389df4b8c2aSAndrew Thompson return; 390df4b8c2aSAndrew Thompson } 391df4b8c2aSAndrew Thompson 392df4b8c2aSAndrew Thompson void 393df4b8c2aSAndrew Thompson libusb20_tr_setup_intr(struct libusb20_transfer *xfer, void *pBuf, uint32_t length, uint32_t timeout) 394df4b8c2aSAndrew Thompson { 395df4b8c2aSAndrew Thompson xfer->ppBuffer[0] = pBuf; 396df4b8c2aSAndrew Thompson xfer->pLength[0] = length; 397df4b8c2aSAndrew Thompson xfer->timeout = timeout; 398df4b8c2aSAndrew Thompson xfer->nFrames = 1; 399df4b8c2aSAndrew Thompson return; 400df4b8c2aSAndrew Thompson } 401df4b8c2aSAndrew Thompson 402df4b8c2aSAndrew Thompson void 403df4b8c2aSAndrew Thompson libusb20_tr_setup_isoc(struct libusb20_transfer *xfer, void *pBuf, uint32_t length, uint16_t frIndex) 404df4b8c2aSAndrew Thompson { 405df4b8c2aSAndrew Thompson if (frIndex >= xfer->maxFrames) { 406df4b8c2aSAndrew Thompson /* should not happen */ 407df4b8c2aSAndrew Thompson return; 408df4b8c2aSAndrew Thompson } 409df4b8c2aSAndrew Thompson xfer->ppBuffer[frIndex] = pBuf; 410df4b8c2aSAndrew Thompson xfer->pLength[frIndex] = length; 411df4b8c2aSAndrew Thompson return; 412df4b8c2aSAndrew Thompson } 413df4b8c2aSAndrew Thompson 414df4b8c2aSAndrew Thompson void 415df4b8c2aSAndrew Thompson libusb20_tr_submit(struct libusb20_transfer *xfer) 416df4b8c2aSAndrew Thompson { 417df4b8c2aSAndrew Thompson if (xfer->is_pending) { 418df4b8c2aSAndrew Thompson /* should not happen */ 419df4b8c2aSAndrew Thompson return; 420df4b8c2aSAndrew Thompson } 421df4b8c2aSAndrew Thompson xfer->is_pending = 1; /* we are pending */ 422df4b8c2aSAndrew Thompson xfer->is_cancel = 0; /* not cancelling */ 423df4b8c2aSAndrew Thompson xfer->is_restart = 0; /* not restarting */ 424df4b8c2aSAndrew Thompson 425df4b8c2aSAndrew Thompson xfer->pdev->methods->tr_submit(xfer); 426df4b8c2aSAndrew Thompson return; 427df4b8c2aSAndrew Thompson } 428df4b8c2aSAndrew Thompson 429df4b8c2aSAndrew Thompson void 430df4b8c2aSAndrew Thompson libusb20_tr_start(struct libusb20_transfer *xfer) 431df4b8c2aSAndrew Thompson { 432df4b8c2aSAndrew Thompson if (xfer->is_pending) { 433df4b8c2aSAndrew Thompson if (xfer->is_cancel) { 434df4b8c2aSAndrew Thompson /* cancelling - restart */ 435df4b8c2aSAndrew Thompson xfer->is_restart = 1; 436df4b8c2aSAndrew Thompson } 437df4b8c2aSAndrew Thompson /* transfer not pending */ 438df4b8c2aSAndrew Thompson return; 439df4b8c2aSAndrew Thompson } 440df4b8c2aSAndrew Thompson /* get into the callback */ 441df4b8c2aSAndrew Thompson libusb20_tr_callback_wrapper(xfer); 442df4b8c2aSAndrew Thompson return; 443df4b8c2aSAndrew Thompson } 444df4b8c2aSAndrew Thompson 445df4b8c2aSAndrew Thompson /* USB device operations */ 446df4b8c2aSAndrew Thompson 447df4b8c2aSAndrew Thompson int 448df4b8c2aSAndrew Thompson libusb20_dev_claim_interface(struct libusb20_device *pdev, uint8_t ifaceIndex) 449df4b8c2aSAndrew Thompson { 450df4b8c2aSAndrew Thompson int error; 451df4b8c2aSAndrew Thompson 452df4b8c2aSAndrew Thompson if (ifaceIndex >= 32) { 453df4b8c2aSAndrew Thompson error = LIBUSB20_ERROR_INVALID_PARAM; 454df4b8c2aSAndrew Thompson } else if (pdev->claimed_interfaces & (1 << ifaceIndex)) { 455df4b8c2aSAndrew Thompson error = LIBUSB20_ERROR_NOT_FOUND; 456df4b8c2aSAndrew Thompson } else { 457df4b8c2aSAndrew Thompson error = pdev->methods->claim_interface(pdev, ifaceIndex); 458df4b8c2aSAndrew Thompson } 459df4b8c2aSAndrew Thompson if (!error) { 460df4b8c2aSAndrew Thompson pdev->claimed_interfaces |= (1 << ifaceIndex); 461df4b8c2aSAndrew Thompson } 462df4b8c2aSAndrew Thompson return (error); 463df4b8c2aSAndrew Thompson } 464df4b8c2aSAndrew Thompson 465df4b8c2aSAndrew Thompson int 466df4b8c2aSAndrew Thompson libusb20_dev_close(struct libusb20_device *pdev) 467df4b8c2aSAndrew Thompson { 468df4b8c2aSAndrew Thompson struct libusb20_transfer *xfer; 469df4b8c2aSAndrew Thompson uint16_t x; 470df4b8c2aSAndrew Thompson int error = 0; 471df4b8c2aSAndrew Thompson 472df4b8c2aSAndrew Thompson if (!pdev->is_opened) { 473df4b8c2aSAndrew Thompson return (LIBUSB20_ERROR_OTHER); 474df4b8c2aSAndrew Thompson } 475df4b8c2aSAndrew Thompson for (x = 0; x != pdev->nTransfer; x++) { 476df4b8c2aSAndrew Thompson xfer = pdev->pTransfer + x; 477df4b8c2aSAndrew Thompson 478df4b8c2aSAndrew Thompson libusb20_tr_drain(xfer); 479df4b8c2aSAndrew Thompson } 480df4b8c2aSAndrew Thompson 481df4b8c2aSAndrew Thompson if (pdev->pTransfer != NULL) { 482df4b8c2aSAndrew Thompson free(pdev->pTransfer); 483df4b8c2aSAndrew Thompson pdev->pTransfer = NULL; 484df4b8c2aSAndrew Thompson } 485df4b8c2aSAndrew Thompson error = pdev->beMethods->close_device(pdev); 486df4b8c2aSAndrew Thompson 487df4b8c2aSAndrew Thompson pdev->methods = &libusb20_dummy_methods; 488df4b8c2aSAndrew Thompson 489df4b8c2aSAndrew Thompson pdev->is_opened = 0; 490df4b8c2aSAndrew Thompson 491df4b8c2aSAndrew Thompson pdev->claimed_interfaces = 0; 492df4b8c2aSAndrew Thompson 493df4b8c2aSAndrew Thompson return (error); 494df4b8c2aSAndrew Thompson } 495df4b8c2aSAndrew Thompson 496df4b8c2aSAndrew Thompson int 497df4b8c2aSAndrew Thompson libusb20_dev_detach_kernel_driver(struct libusb20_device *pdev, uint8_t ifaceIndex) 498df4b8c2aSAndrew Thompson { 499df4b8c2aSAndrew Thompson int error; 500df4b8c2aSAndrew Thompson 501df4b8c2aSAndrew Thompson error = pdev->methods->detach_kernel_driver(pdev, ifaceIndex); 502df4b8c2aSAndrew Thompson return (error); 503df4b8c2aSAndrew Thompson } 504df4b8c2aSAndrew Thompson 505df4b8c2aSAndrew Thompson struct LIBUSB20_DEVICE_DESC_DECODED * 506df4b8c2aSAndrew Thompson libusb20_dev_get_device_desc(struct libusb20_device *pdev) 507df4b8c2aSAndrew Thompson { 508df4b8c2aSAndrew Thompson return (&(pdev->ddesc)); 509df4b8c2aSAndrew Thompson } 510df4b8c2aSAndrew Thompson 511df4b8c2aSAndrew Thompson int 512df4b8c2aSAndrew Thompson libusb20_dev_get_fd(struct libusb20_device *pdev) 513df4b8c2aSAndrew Thompson { 514df4b8c2aSAndrew Thompson return (pdev->file); 515df4b8c2aSAndrew Thompson } 516df4b8c2aSAndrew Thompson 517df4b8c2aSAndrew Thompson int 518df4b8c2aSAndrew Thompson libusb20_dev_kernel_driver_active(struct libusb20_device *pdev, uint8_t ifaceIndex) 519df4b8c2aSAndrew Thompson { 520df4b8c2aSAndrew Thompson int error; 521df4b8c2aSAndrew Thompson 522df4b8c2aSAndrew Thompson error = pdev->methods->kernel_driver_active(pdev, ifaceIndex); 523df4b8c2aSAndrew Thompson return (error); 524df4b8c2aSAndrew Thompson } 525df4b8c2aSAndrew Thompson 526df4b8c2aSAndrew Thompson int 527df4b8c2aSAndrew Thompson libusb20_dev_open(struct libusb20_device *pdev, uint16_t nTransferMax) 528df4b8c2aSAndrew Thompson { 529df4b8c2aSAndrew Thompson struct libusb20_transfer *xfer; 530df4b8c2aSAndrew Thompson uint32_t size; 531df4b8c2aSAndrew Thompson uint16_t x; 532df4b8c2aSAndrew Thompson int error; 533df4b8c2aSAndrew Thompson 534df4b8c2aSAndrew Thompson if (pdev->is_opened) { 535df4b8c2aSAndrew Thompson return (LIBUSB20_ERROR_BUSY); 536df4b8c2aSAndrew Thompson } 537df4b8c2aSAndrew Thompson if (nTransferMax >= 256) { 538df4b8c2aSAndrew Thompson return (LIBUSB20_ERROR_INVALID_PARAM); 539df4b8c2aSAndrew Thompson } else if (nTransferMax != 0) { 540df4b8c2aSAndrew Thompson size = sizeof(pdev->pTransfer[0]) * nTransferMax; 541df4b8c2aSAndrew Thompson pdev->pTransfer = malloc(size); 542df4b8c2aSAndrew Thompson if (pdev->pTransfer == NULL) { 543df4b8c2aSAndrew Thompson return (LIBUSB20_ERROR_NO_MEM); 544df4b8c2aSAndrew Thompson } 545df4b8c2aSAndrew Thompson memset(pdev->pTransfer, 0, size); 546df4b8c2aSAndrew Thompson } 547df4b8c2aSAndrew Thompson /* initialise all transfers */ 548df4b8c2aSAndrew Thompson for (x = 0; x != nTransferMax; x++) { 549df4b8c2aSAndrew Thompson 550df4b8c2aSAndrew Thompson xfer = pdev->pTransfer + x; 551df4b8c2aSAndrew Thompson 552df4b8c2aSAndrew Thompson xfer->pdev = pdev; 553df4b8c2aSAndrew Thompson xfer->trIndex = x; 554df4b8c2aSAndrew Thompson xfer->callback = &dummy_callback; 555df4b8c2aSAndrew Thompson } 556df4b8c2aSAndrew Thompson 557df4b8c2aSAndrew Thompson /* set "nTransfer" early */ 558df4b8c2aSAndrew Thompson pdev->nTransfer = nTransferMax; 559df4b8c2aSAndrew Thompson 560df4b8c2aSAndrew Thompson error = pdev->beMethods->open_device(pdev, nTransferMax); 561df4b8c2aSAndrew Thompson 562df4b8c2aSAndrew Thompson if (error) { 563df4b8c2aSAndrew Thompson if (pdev->pTransfer != NULL) { 564df4b8c2aSAndrew Thompson free(pdev->pTransfer); 565df4b8c2aSAndrew Thompson pdev->pTransfer = NULL; 566df4b8c2aSAndrew Thompson } 567df4b8c2aSAndrew Thompson pdev->file = -1; 568df4b8c2aSAndrew Thompson pdev->file_ctrl = -1; 569df4b8c2aSAndrew Thompson pdev->nTransfer = 0; 570df4b8c2aSAndrew Thompson } else { 571df4b8c2aSAndrew Thompson pdev->is_opened = 1; 572df4b8c2aSAndrew Thompson } 573df4b8c2aSAndrew Thompson return (error); 574df4b8c2aSAndrew Thompson } 575df4b8c2aSAndrew Thompson 576df4b8c2aSAndrew Thompson int 577df4b8c2aSAndrew Thompson libusb20_dev_release_interface(struct libusb20_device *pdev, uint8_t ifaceIndex) 578df4b8c2aSAndrew Thompson { 579df4b8c2aSAndrew Thompson int error; 580df4b8c2aSAndrew Thompson 581df4b8c2aSAndrew Thompson if (ifaceIndex >= 32) { 582df4b8c2aSAndrew Thompson error = LIBUSB20_ERROR_INVALID_PARAM; 583df4b8c2aSAndrew Thompson } else if (!(pdev->claimed_interfaces & (1 << ifaceIndex))) { 584df4b8c2aSAndrew Thompson error = LIBUSB20_ERROR_NOT_FOUND; 585df4b8c2aSAndrew Thompson } else { 586df4b8c2aSAndrew Thompson error = pdev->methods->release_interface(pdev, ifaceIndex); 587df4b8c2aSAndrew Thompson } 588df4b8c2aSAndrew Thompson if (!error) { 589df4b8c2aSAndrew Thompson pdev->claimed_interfaces &= ~(1 << ifaceIndex); 590df4b8c2aSAndrew Thompson } 591df4b8c2aSAndrew Thompson return (error); 592df4b8c2aSAndrew Thompson } 593df4b8c2aSAndrew Thompson 594df4b8c2aSAndrew Thompson int 595df4b8c2aSAndrew Thompson libusb20_dev_reset(struct libusb20_device *pdev) 596df4b8c2aSAndrew Thompson { 597df4b8c2aSAndrew Thompson int error; 598df4b8c2aSAndrew Thompson 599df4b8c2aSAndrew Thompson error = pdev->methods->reset_device(pdev); 600df4b8c2aSAndrew Thompson return (error); 601df4b8c2aSAndrew Thompson } 602df4b8c2aSAndrew Thompson 603df4b8c2aSAndrew Thompson int 604df4b8c2aSAndrew Thompson libusb20_dev_set_power_mode(struct libusb20_device *pdev, uint8_t power_mode) 605df4b8c2aSAndrew Thompson { 606df4b8c2aSAndrew Thompson int error; 607df4b8c2aSAndrew Thompson 608df4b8c2aSAndrew Thompson error = pdev->methods->set_power_mode(pdev, power_mode); 609df4b8c2aSAndrew Thompson return (error); 610df4b8c2aSAndrew Thompson } 611df4b8c2aSAndrew Thompson 612df4b8c2aSAndrew Thompson uint8_t 613df4b8c2aSAndrew Thompson libusb20_dev_get_power_mode(struct libusb20_device *pdev) 614df4b8c2aSAndrew Thompson { 615df4b8c2aSAndrew Thompson int error; 616df4b8c2aSAndrew Thompson uint8_t power_mode; 617df4b8c2aSAndrew Thompson 618df4b8c2aSAndrew Thompson error = pdev->methods->get_power_mode(pdev, &power_mode); 619df4b8c2aSAndrew Thompson if (error) 620df4b8c2aSAndrew Thompson power_mode = LIBUSB20_POWER_ON; /* fake power mode */ 621df4b8c2aSAndrew Thompson return (power_mode); 622df4b8c2aSAndrew Thompson } 623df4b8c2aSAndrew Thompson 624df4b8c2aSAndrew Thompson int 625df4b8c2aSAndrew Thompson libusb20_dev_set_alt_index(struct libusb20_device *pdev, uint8_t ifaceIndex, uint8_t altIndex) 626df4b8c2aSAndrew Thompson { 627df4b8c2aSAndrew Thompson int error; 628df4b8c2aSAndrew Thompson 629df4b8c2aSAndrew Thompson error = pdev->methods->set_alt_index(pdev, ifaceIndex, altIndex); 630df4b8c2aSAndrew Thompson return (error); 631df4b8c2aSAndrew Thompson } 632df4b8c2aSAndrew Thompson 633df4b8c2aSAndrew Thompson int 634df4b8c2aSAndrew Thompson libusb20_dev_set_config_index(struct libusb20_device *pdev, uint8_t configIndex) 635df4b8c2aSAndrew Thompson { 636df4b8c2aSAndrew Thompson int error; 637df4b8c2aSAndrew Thompson 638df4b8c2aSAndrew Thompson error = pdev->methods->set_config_index(pdev, configIndex); 639df4b8c2aSAndrew Thompson return (error); 640df4b8c2aSAndrew Thompson } 641df4b8c2aSAndrew Thompson 642df4b8c2aSAndrew Thompson int 643df4b8c2aSAndrew Thompson libusb20_dev_request_sync(struct libusb20_device *pdev, 644df4b8c2aSAndrew Thompson struct LIBUSB20_CONTROL_SETUP_DECODED *setup, void *data, 645df4b8c2aSAndrew Thompson uint16_t *pactlen, uint32_t timeout, uint8_t flags) 646df4b8c2aSAndrew Thompson { 647df4b8c2aSAndrew Thompson int error; 648df4b8c2aSAndrew Thompson 649df4b8c2aSAndrew Thompson error = pdev->methods->do_request_sync(pdev, 650df4b8c2aSAndrew Thompson setup, data, pactlen, timeout, flags); 651df4b8c2aSAndrew Thompson return (error); 652df4b8c2aSAndrew Thompson } 653df4b8c2aSAndrew Thompson 654df4b8c2aSAndrew Thompson int 655df4b8c2aSAndrew Thompson libusb20_dev_req_string_sync(struct libusb20_device *pdev, 656df4b8c2aSAndrew Thompson uint8_t str_index, uint16_t langid, void *ptr, uint16_t len) 657df4b8c2aSAndrew Thompson { 658df4b8c2aSAndrew Thompson struct LIBUSB20_CONTROL_SETUP_DECODED req; 659df4b8c2aSAndrew Thompson int error; 660df4b8c2aSAndrew Thompson 661df4b8c2aSAndrew Thompson if (len < 4) { 662df4b8c2aSAndrew Thompson /* invalid length */ 663df4b8c2aSAndrew Thompson return (LIBUSB20_ERROR_INVALID_PARAM); 664df4b8c2aSAndrew Thompson } 665df4b8c2aSAndrew Thompson LIBUSB20_INIT(LIBUSB20_CONTROL_SETUP, &req); 666df4b8c2aSAndrew Thompson 667df4b8c2aSAndrew Thompson /* 668df4b8c2aSAndrew Thompson * We need to read the USB string in two steps else some USB 669df4b8c2aSAndrew Thompson * devices will complain. 670df4b8c2aSAndrew Thompson */ 671df4b8c2aSAndrew Thompson req.bmRequestType = 672df4b8c2aSAndrew Thompson LIBUSB20_REQUEST_TYPE_STANDARD | 673df4b8c2aSAndrew Thompson LIBUSB20_RECIPIENT_DEVICE | 674df4b8c2aSAndrew Thompson LIBUSB20_ENDPOINT_IN; 675df4b8c2aSAndrew Thompson req.bRequest = LIBUSB20_REQUEST_GET_DESCRIPTOR; 676df4b8c2aSAndrew Thompson req.wValue = (LIBUSB20_DT_STRING << 8) | str_index; 677df4b8c2aSAndrew Thompson req.wIndex = langid; 678df4b8c2aSAndrew Thompson req.wLength = 4; /* bytes */ 679df4b8c2aSAndrew Thompson 680df4b8c2aSAndrew Thompson error = libusb20_dev_request_sync(pdev, &req, 681df4b8c2aSAndrew Thompson ptr, NULL, 1000, LIBUSB20_TRANSFER_SINGLE_SHORT_NOT_OK); 682df4b8c2aSAndrew Thompson if (error) { 683df4b8c2aSAndrew Thompson return (error); 684df4b8c2aSAndrew Thompson } 685df4b8c2aSAndrew Thompson req.wLength = *(uint8_t *)ptr; /* bytes */ 686df4b8c2aSAndrew Thompson if (req.wLength > len) { 687df4b8c2aSAndrew Thompson /* partial string read */ 688df4b8c2aSAndrew Thompson req.wLength = len; 689df4b8c2aSAndrew Thompson } 690df4b8c2aSAndrew Thompson error = libusb20_dev_request_sync(pdev, &req, 691df4b8c2aSAndrew Thompson ptr, NULL, 1000, LIBUSB20_TRANSFER_SINGLE_SHORT_NOT_OK); 692df4b8c2aSAndrew Thompson 693df4b8c2aSAndrew Thompson if (error) { 694df4b8c2aSAndrew Thompson return (error); 695df4b8c2aSAndrew Thompson } 696df4b8c2aSAndrew Thompson if (((uint8_t *)ptr)[1] != LIBUSB20_DT_STRING) { 697df4b8c2aSAndrew Thompson return (LIBUSB20_ERROR_OTHER); 698df4b8c2aSAndrew Thompson } 699df4b8c2aSAndrew Thompson return (0); /* success */ 700df4b8c2aSAndrew Thompson } 701df4b8c2aSAndrew Thompson 702df4b8c2aSAndrew Thompson int 703df4b8c2aSAndrew Thompson libusb20_dev_req_string_simple_sync(struct libusb20_device *pdev, 704df4b8c2aSAndrew Thompson uint8_t str_index, void *ptr, uint16_t len) 705df4b8c2aSAndrew Thompson { 706df4b8c2aSAndrew Thompson char *buf; 707df4b8c2aSAndrew Thompson int error; 708df4b8c2aSAndrew Thompson uint16_t langid; 709df4b8c2aSAndrew Thompson uint16_t n; 710df4b8c2aSAndrew Thompson uint16_t i; 711df4b8c2aSAndrew Thompson uint16_t c; 712df4b8c2aSAndrew Thompson uint8_t temp[255]; 713df4b8c2aSAndrew Thompson uint8_t swap; 714df4b8c2aSAndrew Thompson 715df4b8c2aSAndrew Thompson /* the following code derives from the FreeBSD USB kernel */ 716df4b8c2aSAndrew Thompson 717df4b8c2aSAndrew Thompson if ((len < 1) || (ptr == NULL)) { 718df4b8c2aSAndrew Thompson /* too short buffer */ 719df4b8c2aSAndrew Thompson return (LIBUSB20_ERROR_INVALID_PARAM); 720df4b8c2aSAndrew Thompson } 721df4b8c2aSAndrew Thompson error = libusb20_dev_req_string_sync(pdev, 722df4b8c2aSAndrew Thompson 0, 0, temp, sizeof(temp)); 723df4b8c2aSAndrew Thompson if (error < 0) { 724df4b8c2aSAndrew Thompson *(uint8_t *)ptr = 0; /* zero terminate */ 725df4b8c2aSAndrew Thompson return (error); 726df4b8c2aSAndrew Thompson } 727df4b8c2aSAndrew Thompson langid = temp[2] | (temp[3] << 8); 728df4b8c2aSAndrew Thompson 729df4b8c2aSAndrew Thompson error = libusb20_dev_req_string_sync(pdev, str_index, 730df4b8c2aSAndrew Thompson langid, temp, sizeof(temp)); 731df4b8c2aSAndrew Thompson if (error < 0) { 732df4b8c2aSAndrew Thompson *(uint8_t *)ptr = 0; /* zero terminate */ 733df4b8c2aSAndrew Thompson return (error); 734df4b8c2aSAndrew Thompson } 735df4b8c2aSAndrew Thompson if (temp[0] < 2) { 736df4b8c2aSAndrew Thompson /* string length is too short */ 737df4b8c2aSAndrew Thompson *(uint8_t *)ptr = 0; /* zero terminate */ 738df4b8c2aSAndrew Thompson return (LIBUSB20_ERROR_OTHER); 739df4b8c2aSAndrew Thompson } 740df4b8c2aSAndrew Thompson /* reserve one byte for terminating zero */ 741df4b8c2aSAndrew Thompson len--; 742df4b8c2aSAndrew Thompson 743df4b8c2aSAndrew Thompson /* find maximum length */ 744df4b8c2aSAndrew Thompson n = (temp[0] / 2) - 1; 745df4b8c2aSAndrew Thompson if (n > len) { 746df4b8c2aSAndrew Thompson n = len; 747df4b8c2aSAndrew Thompson } 748df4b8c2aSAndrew Thompson /* reset swap state */ 749df4b8c2aSAndrew Thompson swap = 3; 750df4b8c2aSAndrew Thompson 751df4b8c2aSAndrew Thompson /* setup output buffer pointer */ 752df4b8c2aSAndrew Thompson buf = ptr; 753df4b8c2aSAndrew Thompson 754df4b8c2aSAndrew Thompson /* convert and filter */ 755df4b8c2aSAndrew Thompson for (i = 0; (i != n); i++) { 756df4b8c2aSAndrew Thompson c = temp[(2 * i) + 2] | (temp[(2 * i) + 3] << 8); 757df4b8c2aSAndrew Thompson 758df4b8c2aSAndrew Thompson /* convert from Unicode, handle buggy strings */ 759df4b8c2aSAndrew Thompson if (((c & 0xff00) == 0) && (swap & 1)) { 760df4b8c2aSAndrew Thompson /* Little Endian, default */ 761df4b8c2aSAndrew Thompson *buf = c; 762df4b8c2aSAndrew Thompson swap = 1; 763df4b8c2aSAndrew Thompson } else if (((c & 0x00ff) == 0) && (swap & 2)) { 764df4b8c2aSAndrew Thompson /* Big Endian */ 765df4b8c2aSAndrew Thompson *buf = c >> 8; 766df4b8c2aSAndrew Thompson swap = 2; 767df4b8c2aSAndrew Thompson } else { 768df4b8c2aSAndrew Thompson /* skip invalid character */ 769df4b8c2aSAndrew Thompson continue; 770df4b8c2aSAndrew Thompson } 771df4b8c2aSAndrew Thompson /* 772df4b8c2aSAndrew Thompson * Filter by default - we don't allow greater and less than 773df4b8c2aSAndrew Thompson * signs because they might confuse the dmesg printouts! 774df4b8c2aSAndrew Thompson */ 775df4b8c2aSAndrew Thompson if ((*buf == '<') || (*buf == '>') || (!isprint(*buf))) { 776df4b8c2aSAndrew Thompson /* skip invalid character */ 777df4b8c2aSAndrew Thompson continue; 778df4b8c2aSAndrew Thompson } 779df4b8c2aSAndrew Thompson buf++; 780df4b8c2aSAndrew Thompson } 781df4b8c2aSAndrew Thompson *buf = 0; /* zero terminate string */ 782df4b8c2aSAndrew Thompson 783df4b8c2aSAndrew Thompson return (0); 784df4b8c2aSAndrew Thompson } 785df4b8c2aSAndrew Thompson 786df4b8c2aSAndrew Thompson struct libusb20_config * 787df4b8c2aSAndrew Thompson libusb20_dev_alloc_config(struct libusb20_device *pdev, uint8_t configIndex) 788df4b8c2aSAndrew Thompson { 789df4b8c2aSAndrew Thompson struct libusb20_config *retval = NULL; 790df4b8c2aSAndrew Thompson uint8_t *ptr; 791df4b8c2aSAndrew Thompson uint16_t len; 792df4b8c2aSAndrew Thompson uint8_t do_close; 793df4b8c2aSAndrew Thompson int error; 794df4b8c2aSAndrew Thompson 795df4b8c2aSAndrew Thompson if (!pdev->is_opened) { 796df4b8c2aSAndrew Thompson error = libusb20_dev_open(pdev, 0); 797df4b8c2aSAndrew Thompson if (error) { 798df4b8c2aSAndrew Thompson return (NULL); 799df4b8c2aSAndrew Thompson } 800df4b8c2aSAndrew Thompson do_close = 1; 801df4b8c2aSAndrew Thompson } else { 802df4b8c2aSAndrew Thompson do_close = 0; 803df4b8c2aSAndrew Thompson } 804df4b8c2aSAndrew Thompson error = pdev->methods->get_config_desc_full(pdev, 805df4b8c2aSAndrew Thompson &ptr, &len, configIndex); 806df4b8c2aSAndrew Thompson 807df4b8c2aSAndrew Thompson if (error) { 808df4b8c2aSAndrew Thompson goto done; 809df4b8c2aSAndrew Thompson } 810df4b8c2aSAndrew Thompson /* parse new config descriptor */ 811df4b8c2aSAndrew Thompson retval = libusb20_parse_config_desc(ptr); 812df4b8c2aSAndrew Thompson 813df4b8c2aSAndrew Thompson /* free config descriptor */ 814df4b8c2aSAndrew Thompson free(ptr); 815df4b8c2aSAndrew Thompson 816df4b8c2aSAndrew Thompson done: 817df4b8c2aSAndrew Thompson if (do_close) { 818df4b8c2aSAndrew Thompson error = libusb20_dev_close(pdev); 819df4b8c2aSAndrew Thompson } 820df4b8c2aSAndrew Thompson return (retval); 821df4b8c2aSAndrew Thompson } 822df4b8c2aSAndrew Thompson 823df4b8c2aSAndrew Thompson struct libusb20_device * 824df4b8c2aSAndrew Thompson libusb20_dev_alloc(void) 825df4b8c2aSAndrew Thompson { 826df4b8c2aSAndrew Thompson struct libusb20_device *pdev; 827df4b8c2aSAndrew Thompson 828df4b8c2aSAndrew Thompson pdev = malloc(sizeof(*pdev)); 829df4b8c2aSAndrew Thompson if (pdev == NULL) { 830df4b8c2aSAndrew Thompson return (NULL); 831df4b8c2aSAndrew Thompson } 832df4b8c2aSAndrew Thompson memset(pdev, 0, sizeof(*pdev)); 833df4b8c2aSAndrew Thompson 834df4b8c2aSAndrew Thompson pdev->file = -1; 835df4b8c2aSAndrew Thompson pdev->file_ctrl = -1; 836df4b8c2aSAndrew Thompson pdev->methods = &libusb20_dummy_methods; 837df4b8c2aSAndrew Thompson return (pdev); 838df4b8c2aSAndrew Thompson } 839df4b8c2aSAndrew Thompson 840df4b8c2aSAndrew Thompson uint8_t 841df4b8c2aSAndrew Thompson libusb20_dev_get_config_index(struct libusb20_device *pdev) 842df4b8c2aSAndrew Thompson { 843df4b8c2aSAndrew Thompson int error; 844df4b8c2aSAndrew Thompson uint8_t cfg_index; 845df4b8c2aSAndrew Thompson uint8_t do_close; 846df4b8c2aSAndrew Thompson 847df4b8c2aSAndrew Thompson if (!pdev->is_opened) { 848df4b8c2aSAndrew Thompson error = libusb20_dev_open(pdev, 0); 849df4b8c2aSAndrew Thompson if (error == 0) { 850df4b8c2aSAndrew Thompson do_close = 1; 851df4b8c2aSAndrew Thompson } else { 852df4b8c2aSAndrew Thompson do_close = 0; 853df4b8c2aSAndrew Thompson } 854df4b8c2aSAndrew Thompson } else { 855df4b8c2aSAndrew Thompson do_close = 0; 856df4b8c2aSAndrew Thompson } 857df4b8c2aSAndrew Thompson 858df4b8c2aSAndrew Thompson error = pdev->methods->get_config_index(pdev, &cfg_index); 859df4b8c2aSAndrew Thompson if (error) { 860df4b8c2aSAndrew Thompson cfg_index = 0 - 1; /* current config index */ 861df4b8c2aSAndrew Thompson } 862df4b8c2aSAndrew Thompson if (do_close) { 863df4b8c2aSAndrew Thompson if (libusb20_dev_close(pdev)) { 864df4b8c2aSAndrew Thompson /* ignore */ 865df4b8c2aSAndrew Thompson } 866df4b8c2aSAndrew Thompson } 867df4b8c2aSAndrew Thompson return (cfg_index); 868df4b8c2aSAndrew Thompson } 869df4b8c2aSAndrew Thompson 870df4b8c2aSAndrew Thompson uint8_t 871df4b8c2aSAndrew Thompson libusb20_dev_get_mode(struct libusb20_device *pdev) 872df4b8c2aSAndrew Thompson { 873df4b8c2aSAndrew Thompson return (pdev->usb_mode); 874df4b8c2aSAndrew Thompson } 875df4b8c2aSAndrew Thompson 876df4b8c2aSAndrew Thompson uint8_t 877df4b8c2aSAndrew Thompson libusb20_dev_get_speed(struct libusb20_device *pdev) 878df4b8c2aSAndrew Thompson { 879df4b8c2aSAndrew Thompson return (pdev->usb_speed); 880df4b8c2aSAndrew Thompson } 881df4b8c2aSAndrew Thompson 882df4b8c2aSAndrew Thompson /* if this function returns an error, the device is gone */ 883df4b8c2aSAndrew Thompson int 884df4b8c2aSAndrew Thompson libusb20_dev_process(struct libusb20_device *pdev) 885df4b8c2aSAndrew Thompson { 886df4b8c2aSAndrew Thompson int error; 887df4b8c2aSAndrew Thompson 888df4b8c2aSAndrew Thompson error = pdev->methods->process(pdev); 889df4b8c2aSAndrew Thompson return (error); 890df4b8c2aSAndrew Thompson } 891df4b8c2aSAndrew Thompson 892df4b8c2aSAndrew Thompson void 893df4b8c2aSAndrew Thompson libusb20_dev_wait_process(struct libusb20_device *pdev, int timeout) 894df4b8c2aSAndrew Thompson { 895df4b8c2aSAndrew Thompson struct pollfd pfd[1]; 896df4b8c2aSAndrew Thompson 897df4b8c2aSAndrew Thompson if (!pdev->is_opened) { 898df4b8c2aSAndrew Thompson return; 899df4b8c2aSAndrew Thompson } 900df4b8c2aSAndrew Thompson pfd[0].fd = pdev->file; 901df4b8c2aSAndrew Thompson pfd[0].events = (POLLIN | POLLOUT | POLLRDNORM | POLLWRNORM); 902df4b8c2aSAndrew Thompson pfd[0].revents = 0; 903df4b8c2aSAndrew Thompson 904df4b8c2aSAndrew Thompson if (poll(pfd, 1, timeout)) { 905df4b8c2aSAndrew Thompson /* ignore any error */ 906df4b8c2aSAndrew Thompson } 907df4b8c2aSAndrew Thompson return; 908df4b8c2aSAndrew Thompson } 909df4b8c2aSAndrew Thompson 910df4b8c2aSAndrew Thompson void 911df4b8c2aSAndrew Thompson libusb20_dev_free(struct libusb20_device *pdev) 912df4b8c2aSAndrew Thompson { 913df4b8c2aSAndrew Thompson if (pdev == NULL) { 914df4b8c2aSAndrew Thompson /* be NULL safe */ 915df4b8c2aSAndrew Thompson return; 916df4b8c2aSAndrew Thompson } 917df4b8c2aSAndrew Thompson if (pdev->is_opened) { 918df4b8c2aSAndrew Thompson if (libusb20_dev_close(pdev)) { 919df4b8c2aSAndrew Thompson /* ignore any errors */ 920df4b8c2aSAndrew Thompson } 921df4b8c2aSAndrew Thompson } 922df4b8c2aSAndrew Thompson free(pdev); 923df4b8c2aSAndrew Thompson return; 924df4b8c2aSAndrew Thompson } 925df4b8c2aSAndrew Thompson 926df4b8c2aSAndrew Thompson int 927df4b8c2aSAndrew Thompson libusb20_dev_get_info(struct libusb20_device *pdev, 928760bc48eSAndrew Thompson struct usb_device_info *pinfo) 929df4b8c2aSAndrew Thompson { 930df4b8c2aSAndrew Thompson if (pinfo == NULL) 931df4b8c2aSAndrew Thompson return (LIBUSB20_ERROR_INVALID_PARAM); 932df4b8c2aSAndrew Thompson 933df4b8c2aSAndrew Thompson return (pdev->beMethods->dev_get_info(pdev, pinfo)); 934df4b8c2aSAndrew Thompson } 935df4b8c2aSAndrew Thompson 936df4b8c2aSAndrew Thompson const char * 937df4b8c2aSAndrew Thompson libusb20_dev_get_backend_name(struct libusb20_device *pdev) 938df4b8c2aSAndrew Thompson { 939df4b8c2aSAndrew Thompson return (pdev->beMethods->get_backend_name()); 940df4b8c2aSAndrew Thompson } 941df4b8c2aSAndrew Thompson 942df4b8c2aSAndrew Thompson const char * 943df4b8c2aSAndrew Thompson libusb20_dev_get_desc(struct libusb20_device *pdev) 944df4b8c2aSAndrew Thompson { 945df4b8c2aSAndrew Thompson return (pdev->usb_desc); 946df4b8c2aSAndrew Thompson } 947df4b8c2aSAndrew Thompson 948df4b8c2aSAndrew Thompson void 949df4b8c2aSAndrew Thompson libusb20_dev_set_debug(struct libusb20_device *pdev, int debug) 950df4b8c2aSAndrew Thompson { 951df4b8c2aSAndrew Thompson pdev->debug = debug; 952df4b8c2aSAndrew Thompson return; 953df4b8c2aSAndrew Thompson } 954df4b8c2aSAndrew Thompson 955df4b8c2aSAndrew Thompson int 956df4b8c2aSAndrew Thompson libusb20_dev_get_debug(struct libusb20_device *pdev) 957df4b8c2aSAndrew Thompson { 958df4b8c2aSAndrew Thompson return (pdev->debug); 959df4b8c2aSAndrew Thompson } 960df4b8c2aSAndrew Thompson 961df4b8c2aSAndrew Thompson uint8_t 962df4b8c2aSAndrew Thompson libusb20_dev_get_address(struct libusb20_device *pdev) 963df4b8c2aSAndrew Thompson { 964df4b8c2aSAndrew Thompson return (pdev->device_address); 965df4b8c2aSAndrew Thompson } 966df4b8c2aSAndrew Thompson 967df4b8c2aSAndrew Thompson uint8_t 968df4b8c2aSAndrew Thompson libusb20_dev_get_bus_number(struct libusb20_device *pdev) 969df4b8c2aSAndrew Thompson { 970df4b8c2aSAndrew Thompson return (pdev->bus_number); 971df4b8c2aSAndrew Thompson } 972df4b8c2aSAndrew Thompson 973df4b8c2aSAndrew Thompson int 974df4b8c2aSAndrew Thompson libusb20_dev_get_iface_desc(struct libusb20_device *pdev, 975df4b8c2aSAndrew Thompson uint8_t iface_index, char *buf, uint8_t len) 976df4b8c2aSAndrew Thompson { 977df4b8c2aSAndrew Thompson if ((buf == NULL) || (len == 0)) 978df4b8c2aSAndrew Thompson return (LIBUSB20_ERROR_INVALID_PARAM); 979df4b8c2aSAndrew Thompson 980df4b8c2aSAndrew Thompson return (pdev->beMethods->dev_get_iface_desc( 981df4b8c2aSAndrew Thompson pdev, iface_index, buf, len)); 982df4b8c2aSAndrew Thompson } 983df4b8c2aSAndrew Thompson 984df4b8c2aSAndrew Thompson /* USB backend operations */ 985df4b8c2aSAndrew Thompson 986df4b8c2aSAndrew Thompson int 987df4b8c2aSAndrew Thompson libusb20_be_get_dev_quirk(struct libusb20_backend *pbe, 988df4b8c2aSAndrew Thompson uint16_t quirk_index, struct libusb20_quirk *pq) 989df4b8c2aSAndrew Thompson { 990df4b8c2aSAndrew Thompson return (pbe->methods->root_get_dev_quirk(pbe, quirk_index, pq)); 991df4b8c2aSAndrew Thompson } 992df4b8c2aSAndrew Thompson 993df4b8c2aSAndrew Thompson int 994df4b8c2aSAndrew Thompson libusb20_be_get_quirk_name(struct libusb20_backend *pbe, 995df4b8c2aSAndrew Thompson uint16_t quirk_index, struct libusb20_quirk *pq) 996df4b8c2aSAndrew Thompson { 997df4b8c2aSAndrew Thompson return (pbe->methods->root_get_quirk_name(pbe, quirk_index, pq)); 998df4b8c2aSAndrew Thompson } 999df4b8c2aSAndrew Thompson 1000df4b8c2aSAndrew Thompson int 1001df4b8c2aSAndrew Thompson libusb20_be_add_dev_quirk(struct libusb20_backend *pbe, 1002df4b8c2aSAndrew Thompson struct libusb20_quirk *pq) 1003df4b8c2aSAndrew Thompson { 1004df4b8c2aSAndrew Thompson return (pbe->methods->root_add_dev_quirk(pbe, pq)); 1005df4b8c2aSAndrew Thompson } 1006df4b8c2aSAndrew Thompson 1007df4b8c2aSAndrew Thompson int 1008df4b8c2aSAndrew Thompson libusb20_be_remove_dev_quirk(struct libusb20_backend *pbe, 1009df4b8c2aSAndrew Thompson struct libusb20_quirk *pq) 1010df4b8c2aSAndrew Thompson { 1011df4b8c2aSAndrew Thompson return (pbe->methods->root_remove_dev_quirk(pbe, pq)); 1012df4b8c2aSAndrew Thompson } 1013df4b8c2aSAndrew Thompson 1014df4b8c2aSAndrew Thompson int 1015df4b8c2aSAndrew Thompson libusb20_be_set_template(struct libusb20_backend *pbe, int temp) 1016df4b8c2aSAndrew Thompson { 1017df4b8c2aSAndrew Thompson return (pbe->methods->root_set_template(pbe, temp)); 1018df4b8c2aSAndrew Thompson } 1019df4b8c2aSAndrew Thompson 1020df4b8c2aSAndrew Thompson int 1021df4b8c2aSAndrew Thompson libusb20_be_get_template(struct libusb20_backend *pbe, int *ptemp) 1022df4b8c2aSAndrew Thompson { 1023df4b8c2aSAndrew Thompson int temp; 1024df4b8c2aSAndrew Thompson 1025df4b8c2aSAndrew Thompson if (ptemp == NULL) 1026df4b8c2aSAndrew Thompson ptemp = &temp; 1027df4b8c2aSAndrew Thompson 1028df4b8c2aSAndrew Thompson return (pbe->methods->root_get_template(pbe, ptemp)); 1029df4b8c2aSAndrew Thompson } 1030df4b8c2aSAndrew Thompson 1031df4b8c2aSAndrew Thompson struct libusb20_device * 1032df4b8c2aSAndrew Thompson libusb20_be_device_foreach(struct libusb20_backend *pbe, struct libusb20_device *pdev) 1033df4b8c2aSAndrew Thompson { 1034df4b8c2aSAndrew Thompson if (pbe == NULL) { 1035df4b8c2aSAndrew Thompson pdev = NULL; 1036df4b8c2aSAndrew Thompson } else if (pdev == NULL) { 1037df4b8c2aSAndrew Thompson pdev = TAILQ_FIRST(&(pbe->usb_devs)); 1038df4b8c2aSAndrew Thompson } else { 1039df4b8c2aSAndrew Thompson pdev = TAILQ_NEXT(pdev, dev_entry); 1040df4b8c2aSAndrew Thompson } 1041df4b8c2aSAndrew Thompson return (pdev); 1042df4b8c2aSAndrew Thompson } 1043df4b8c2aSAndrew Thompson 1044df4b8c2aSAndrew Thompson struct libusb20_backend * 1045df4b8c2aSAndrew Thompson libusb20_be_alloc(const struct libusb20_backend_methods *methods) 1046df4b8c2aSAndrew Thompson { 1047df4b8c2aSAndrew Thompson struct libusb20_backend *pbe; 1048df4b8c2aSAndrew Thompson 1049df4b8c2aSAndrew Thompson pbe = malloc(sizeof(*pbe)); 1050df4b8c2aSAndrew Thompson if (pbe == NULL) { 1051df4b8c2aSAndrew Thompson return (NULL); 1052df4b8c2aSAndrew Thompson } 1053df4b8c2aSAndrew Thompson memset(pbe, 0, sizeof(*pbe)); 1054df4b8c2aSAndrew Thompson 1055df4b8c2aSAndrew Thompson TAILQ_INIT(&(pbe->usb_devs)); 1056df4b8c2aSAndrew Thompson 1057df4b8c2aSAndrew Thompson pbe->methods = methods; /* set backend methods */ 1058df4b8c2aSAndrew Thompson 1059df4b8c2aSAndrew Thompson /* do the initial device scan */ 1060df4b8c2aSAndrew Thompson if (pbe->methods->init_backend) { 1061df4b8c2aSAndrew Thompson pbe->methods->init_backend(pbe); 1062df4b8c2aSAndrew Thompson } 1063df4b8c2aSAndrew Thompson return (pbe); 1064df4b8c2aSAndrew Thompson } 1065df4b8c2aSAndrew Thompson 1066df4b8c2aSAndrew Thompson struct libusb20_backend * 1067df4b8c2aSAndrew Thompson libusb20_be_alloc_linux(void) 1068df4b8c2aSAndrew Thompson { 1069df4b8c2aSAndrew Thompson struct libusb20_backend *pbe; 1070df4b8c2aSAndrew Thompson 1071df4b8c2aSAndrew Thompson #ifdef __linux__ 1072df4b8c2aSAndrew Thompson pbe = libusb20_be_alloc(&libusb20_linux_backend); 1073df4b8c2aSAndrew Thompson #else 1074df4b8c2aSAndrew Thompson pbe = NULL; 1075df4b8c2aSAndrew Thompson #endif 1076df4b8c2aSAndrew Thompson return (pbe); 1077df4b8c2aSAndrew Thompson } 1078df4b8c2aSAndrew Thompson 1079df4b8c2aSAndrew Thompson struct libusb20_backend * 1080df4b8c2aSAndrew Thompson libusb20_be_alloc_ugen20(void) 1081df4b8c2aSAndrew Thompson { 1082df4b8c2aSAndrew Thompson struct libusb20_backend *pbe; 1083df4b8c2aSAndrew Thompson 1084df4b8c2aSAndrew Thompson #ifdef __FreeBSD__ 1085df4b8c2aSAndrew Thompson pbe = libusb20_be_alloc(&libusb20_ugen20_backend); 1086df4b8c2aSAndrew Thompson #else 1087df4b8c2aSAndrew Thompson pbe = NULL; 1088df4b8c2aSAndrew Thompson #endif 1089df4b8c2aSAndrew Thompson return (pbe); 1090df4b8c2aSAndrew Thompson } 1091df4b8c2aSAndrew Thompson 1092df4b8c2aSAndrew Thompson struct libusb20_backend * 1093df4b8c2aSAndrew Thompson libusb20_be_alloc_default(void) 1094df4b8c2aSAndrew Thompson { 1095df4b8c2aSAndrew Thompson struct libusb20_backend *pbe; 1096df4b8c2aSAndrew Thompson 1097df4b8c2aSAndrew Thompson pbe = libusb20_be_alloc_linux(); 1098df4b8c2aSAndrew Thompson if (pbe) { 1099df4b8c2aSAndrew Thompson return (pbe); 1100df4b8c2aSAndrew Thompson } 1101df4b8c2aSAndrew Thompson pbe = libusb20_be_alloc_ugen20(); 1102df4b8c2aSAndrew Thompson if (pbe) { 1103df4b8c2aSAndrew Thompson return (pbe); 1104df4b8c2aSAndrew Thompson } 1105df4b8c2aSAndrew Thompson return (NULL); /* no backend found */ 1106df4b8c2aSAndrew Thompson } 1107df4b8c2aSAndrew Thompson 1108df4b8c2aSAndrew Thompson void 1109df4b8c2aSAndrew Thompson libusb20_be_free(struct libusb20_backend *pbe) 1110df4b8c2aSAndrew Thompson { 1111df4b8c2aSAndrew Thompson struct libusb20_device *pdev; 1112df4b8c2aSAndrew Thompson 1113df4b8c2aSAndrew Thompson if (pbe == NULL) { 1114df4b8c2aSAndrew Thompson /* be NULL safe */ 1115df4b8c2aSAndrew Thompson return; 1116df4b8c2aSAndrew Thompson } 1117df4b8c2aSAndrew Thompson while ((pdev = libusb20_be_device_foreach(pbe, NULL))) { 1118df4b8c2aSAndrew Thompson libusb20_be_dequeue_device(pbe, pdev); 1119df4b8c2aSAndrew Thompson libusb20_dev_free(pdev); 1120df4b8c2aSAndrew Thompson } 1121df4b8c2aSAndrew Thompson if (pbe->methods->exit_backend) { 1122df4b8c2aSAndrew Thompson pbe->methods->exit_backend(pbe); 1123df4b8c2aSAndrew Thompson } 1124df4b8c2aSAndrew Thompson return; 1125df4b8c2aSAndrew Thompson } 1126df4b8c2aSAndrew Thompson 1127df4b8c2aSAndrew Thompson void 1128df4b8c2aSAndrew Thompson libusb20_be_enqueue_device(struct libusb20_backend *pbe, struct libusb20_device *pdev) 1129df4b8c2aSAndrew Thompson { 1130df4b8c2aSAndrew Thompson pdev->beMethods = pbe->methods; /* copy backend methods */ 1131df4b8c2aSAndrew Thompson TAILQ_INSERT_TAIL(&(pbe->usb_devs), pdev, dev_entry); 1132df4b8c2aSAndrew Thompson return; 1133df4b8c2aSAndrew Thompson } 1134df4b8c2aSAndrew Thompson 1135df4b8c2aSAndrew Thompson void 1136df4b8c2aSAndrew Thompson libusb20_be_dequeue_device(struct libusb20_backend *pbe, 1137df4b8c2aSAndrew Thompson struct libusb20_device *pdev) 1138df4b8c2aSAndrew Thompson { 1139df4b8c2aSAndrew Thompson TAILQ_REMOVE(&(pbe->usb_devs), pdev, dev_entry); 1140df4b8c2aSAndrew Thompson return; 1141df4b8c2aSAndrew Thompson } 1142