libusb/os/openbsd_usb.c

   1 /*
   2  * Copyright © 2011-2013 Martin Pieuchot <mpi@openbsd.org>
   3  *
   4  * This library is free software; you can redistribute it and/or
   5  * modify it under the terms of the GNU Lesser General Public
   6  * License as published by the Free Software Foundation; either
   7  * version 2.1 of the License, or (at your option) any later version.
   8  *
   9  * This library is distributed in the hope that it will be useful,
  10  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  11  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
  12  * Lesser General Public License for more details.
  13  *
  14  * You should have received a copy of the GNU Lesser General Public
  15  * License along with this library; if not, write to the Free Software
  16  * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA
  17  */
  18
  19 #include <sys/time.h>
  20 #include <sys/types.h>
  21
  22 #include <errno.h>
  23 #include <fcntl.h>
  24 #include <stdio.h>
  25 #include <stdlib.h>
  26 #include <string.h>
  27 #include <unistd.h>
  28
  29 #include <dev/usb/usb.h>
  30
  31 #include "libusb.h"
  32 #include "libusbi.h"
  33
  34 struct device_priv {
  35         char *devname;                          /* name of the ugen(4) node */
  36         int fd;                                 /* device file descriptor */
  37
  38         unsigned char *cdesc;                   /* active config descriptor */
  39         usb_device_descriptor_t ddesc;          /* usb device descriptor */
  40 };
  41
  42 struct handle_priv {
  43         int pipe[2];                            /* for event notification */
  44         int endpoints[USB_MAX_ENDPOINTS];
  45 };
  46
  47 /*
  48  * Backend functions
  49  */
  50 static int obsd_get_device_list(struct libusb_context *,
  51     struct discovered_devs **);
  52 static int obsd_open(struct libusb_device_handle *);
  53 static void obsd_close(struct libusb_device_handle *);
  54
  55 static int obsd_get_device_descriptor(struct libusb_device *, unsigned char *,
  56     int *);
  57 static int obsd_get_active_config_descriptor(struct libusb_device *,
  58     unsigned char *, size_t, int *);
  59 static int obsd_get_config_descriptor(struct libusb_device *, uint8_t,
  60     unsigned char *, size_t, int *);
  61
  62 static int obsd_get_configuration(struct libusb_device_handle *, int *);
  63 static int obsd_set_configuration(struct libusb_device_handle *, int);
  64
  65 static int obsd_claim_interface(struct libusb_device_handle *, int);
  66 static int obsd_release_interface(struct libusb_device_handle *, int);
  67
  68 static int obsd_set_interface_altsetting(struct libusb_device_handle *, int,
  69     int);
  70 static int obsd_clear_halt(struct libusb_device_handle *, unsigned char);
  71 static int obsd_reset_device(struct libusb_device_handle *);
  72 static void obsd_destroy_device(struct libusb_device *);
  73
  74 static int obsd_submit_transfer(struct usbi_transfer *);
  75 static int obsd_cancel_transfer(struct usbi_transfer *);
  76 static void obsd_clear_transfer_priv(struct usbi_transfer *);
  77 static int obsd_handle_events(struct libusb_context *ctx, struct pollfd *,
  78     nfds_t, int);
  79 static int obsd_clock_gettime(int, struct timespec *);
  80
  81 /*
  82  * Private functions
  83  */
  84 static int _errno_to_libusb(int);
  85 static int _cache_active_config_descriptor(struct libusb_device *);
  86 static int _sync_control_transfer(struct usbi_transfer *);
  87 static int _sync_gen_transfer(struct usbi_transfer *);
  88 static int _access_endpoint(struct libusb_transfer *);
  89
  90 static int _bus_open(int);
  91
  92
  93 const struct usbi_os_backend openbsd_backend = {
  94         "Synchronous OpenBSD backend",
  95         0,
  96         NULL,                           /* init() */
  97         NULL,                           /* exit() */
  98         obsd_get_device_list,
  99         NULL,                           /* hotplug_poll */
 100         obsd_open,
 101         obsd_close,
 102
 103         obsd_get_device_descriptor,
 104         obsd_get_active_config_descriptor,
 105         obsd_get_config_descriptor,
 106         NULL,                           /* get_config_descriptor_by_value() */
 107
 108         obsd_get_configuration,
 109         obsd_set_configuration,
 110
 111         obsd_claim_interface,
 112         obsd_release_interface,
 113
 114         obsd_set_interface_altsetting,
 115         obsd_clear_halt,
 116         obsd_reset_device,
 117
 118         NULL,                           /* kernel_driver_active() */
 119         NULL,                           /* detach_kernel_driver() */
 120         NULL,                           /* attach_kernel_driver() */
 121
 122         obsd_destroy_device,
 123
 124         obsd_submit_transfer,
 125         obsd_cancel_transfer,
 126         obsd_clear_transfer_priv,
 127
 128         obsd_handle_events,
 129
 130         obsd_clock_gettime,
 131         sizeof(struct device_priv),
 132         sizeof(struct handle_priv),
 133         0,                              /* transfer_priv_size */
 134         0,                              /* add_iso_packet_size */
 135 };
 136
 137 #define DEVPATH "/dev/"
 138 #define USBDEV  DEVPATH "usb"
 139
 140 int
 141 obsd_get_device_list(struct libusb_context * ctx,
 142         struct discovered_devs **discdevs)
 143 {
 144         struct discovered_devs *ddd;
 145         struct libusb_device *dev;
 146         struct device_priv *dpriv;
 147         struct usb_device_info di;
 148         struct usb_device_ddesc dd;
 149         unsigned long session_id;
 150         char devices[USB_MAX_DEVICES];
 151         char busnode[16];
 152         char *udevname;
 153         int fd, addr, i, j;
 154
 155         usbi_dbg("");
 156
 157         for (i = 0; i < 8; i++) {
 158                 snprintf(busnode, sizeof(busnode), USBDEV "%d", i);
 159
 160                 if ((fd = open(busnode, O_RDWR)) < 0) {
 161                         if (errno != ENOENT && errno != ENXIO)
 162                                 usbi_err(ctx, "could not open %s", busnode);
 163                         continue;
 164                 }
 165
 166                 bzero(devices, sizeof(devices));
 167                 for (addr = 1; addr < USB_MAX_DEVICES; addr++) {
 168                         if (devices[addr])
 169                                 continue;
 170
 171                         di.udi_addr = addr;
 172                         if (ioctl(fd, USB_DEVICEINFO, &di) < 0)
 173                                 continue;
 174
 175                         /*
 176                          * XXX If ugen(4) is attached to the USB device
 177                          * it will be used.
 178                          */
 179                         udevname = NULL;
 180                         for (j = 0; j < USB_MAX_DEVNAMES; j++)
 181                                 if (!strncmp("ugen", di.udi_devnames[j], 4)) {
 182                                         udevname = strdup(di.udi_devnames[j]);
 183                                         break;
 184                                 }
 185
 186                         session_id = (di.udi_bus << 8 | di.udi_addr);
 187                         dev = usbi_get_device_by_session_id(ctx, session_id);
 188
 189                         if (dev == NULL) {
 190                                 dev = usbi_alloc_device(ctx, session_id);
 191                                 if (dev == NULL) {
 192                                         close(fd);
 193                                         return (LIBUSB_ERROR_NO_MEM);
 194                                 }
 195
 196                                 dev->bus_number = di.udi_bus;
 197                                 dev->device_address = di.udi_addr;
 198                                 dev->speed = di.udi_speed;
 199
 200                                 dpriv = (struct device_priv *)dev->os_priv;
 201                                 dpriv->fd = -1;
 202                                 dpriv->cdesc = NULL;
 203                                 dpriv->devname = udevname;
 204
 205                                 dd.udd_bus = di.udi_bus;
 206                                 dd.udd_addr = di.udi_addr;
 207                                 if (ioctl(fd, USB_DEVICE_GET_DDESC, &dd) < 0) {
 208                                         libusb_unref_device(dev);
 209                                         continue;
 210                                 }
 211                                 dpriv->ddesc = dd.udd_desc;
 212
 213                                 if (_cache_active_config_descriptor(dev)) {
 214                                         libusb_unref_device(dev);
 215                                         continue;
 216                                 }
 217
 218                                 if (usbi_sanitize_device(dev)) {
 219                                         libusb_unref_device(dev);
 220                                         continue;
 221                                 }
 222                         }
 223
 224                         ddd = discovered_devs_append(*discdevs, dev);
 225                         if (ddd == NULL) {
 226                                 close(fd);
 227                                 return (LIBUSB_ERROR_NO_MEM);
 228                         }
 229                         libusb_unref_device(dev);
 230
 231                         *discdevs = ddd;
 232                         devices[addr] = 1;
 233                 }
 234
 235                 close(fd);
 236         }
 237
 238         return (LIBUSB_SUCCESS);
 239 }
 240
 241 int
 242 obsd_open(struct libusb_device_handle *handle)
 243 {
 244         struct handle_priv *hpriv = (struct handle_priv *)handle->os_priv;
 245         struct device_priv *dpriv = (struct device_priv *)handle->dev->os_priv;
 246         char devnode[16];
 247
 248         if (dpriv->devname) {
 249                 /*
 250                  * Only open ugen(4) attached devices read-write, all
 251                  * read-only operations are done through the bus node.
 252                  */
 253                 snprintf(devnode, sizeof(devnode), DEVPATH "%s.00",
 254                     dpriv->devname);
 255                 dpriv->fd = open(devnode, O_RDWR);
 256                 if (dpriv->fd < 0)
 257                         return _errno_to_libusb(errno);
 258
 259                 usbi_dbg("open %s: fd %d", devnode, dpriv->fd);
 260         }
 261
 262         if (pipe(hpriv->pipe) < 0)
 263                 return _errno_to_libusb(errno);
 264
 265         return usbi_add_pollfd(HANDLE_CTX(handle), hpriv->pipe[0], POLLIN);
 266 }
 267
 268 void
 269 obsd_close(struct libusb_device_handle *handle)
 270 {
 271         struct handle_priv *hpriv = (struct handle_priv *)handle->os_priv;
 272         struct device_priv *dpriv = (struct device_priv *)handle->dev->os_priv;
 273
 274         if (dpriv->devname) {
 275                 usbi_dbg("close: fd %d", dpriv->fd);
 276
 277                 close(dpriv->fd);
 278                 dpriv->fd = -1;
 279         }
 280
 281         usbi_remove_pollfd(HANDLE_CTX(handle), hpriv->pipe[0]);
 282
 283         close(hpriv->pipe[0]);
 284         close(hpriv->pipe[1]);
 285 }
 286
 287 int
 288 obsd_get_device_descriptor(struct libusb_device *dev, unsigned char *buf,
 289     int *host_endian)
 290 {
 291         struct device_priv *dpriv = (struct device_priv *)dev->os_priv;
 292
 293         usbi_dbg("");
 294
 295         memcpy(buf, &dpriv->ddesc, DEVICE_DESC_LENGTH);
 296
 297         *host_endian = 0;
 298
 299         return (LIBUSB_SUCCESS);
 300 }
 301
 302 int
 303 obsd_get_active_config_descriptor(struct libusb_device *dev,
 304     unsigned char *buf, size_t len, int *host_endian)
 305 {
 306         struct device_priv *dpriv = (struct device_priv *)dev->os_priv;
 307         usb_config_descriptor_t *ucd = (usb_config_descriptor_t *)dpriv->cdesc;
 308
 309         len = MIN(len, UGETW(ucd->wTotalLength));
 310
 311         usbi_dbg("len %d", len);
 312
 313         memcpy(buf, dpriv->cdesc, len);
 314
 315         *host_endian = 0;
 316
 317         return (len);
 318 }
 319
 320 int
 321 obsd_get_config_descriptor(struct libusb_device *dev, uint8_t idx,
 322     unsigned char *buf, size_t len, int *host_endian)
 323 {
 324         struct usb_device_fdesc udf;
 325         int fd, err;
 326
 327         if ((fd = _bus_open(dev->bus_number)) < 0)
 328                 return _errno_to_libusb(errno);
 329
 330         udf.udf_bus = dev->bus_number;
 331         udf.udf_addr = dev->device_address;
 332         udf.udf_config_index = idx;
 333         udf.udf_size = len;
 334         udf.udf_data = buf;
 335
 336         usbi_dbg("index %d, len %d", udf.udf_config_index, len);
 337
 338         if (ioctl(fd, USB_DEVICE_GET_FDESC, &udf) < 0) {
 339                 err = errno;
 340                 close(fd);
 341                 return _errno_to_libusb(err);
 342         }
 343         close(fd);
 344
 345         *host_endian = 0;
 346
 347         return (len);
 348 }
 349
 350 int
 351 obsd_get_configuration(struct libusb_device_handle *handle, int *config)
 352 {
 353         struct device_priv *dpriv = (struct device_priv *)handle->dev->os_priv;
 354         usb_config_descriptor_t *ucd = (usb_config_descriptor_t *)dpriv->cdesc;
 355
 356         *config = ucd->bConfigurationValue;
 357
 358         usbi_dbg("bConfigurationValue %d", *config);
 359
 360         return (LIBUSB_SUCCESS);
 361 }
 362
 363 int
 364 obsd_set_configuration(struct libusb_device_handle *handle, int config)
 365 {
 366         struct device_priv *dpriv = (struct device_priv *)handle->dev->os_priv;
 367
 368         if (dpriv->devname == NULL)
 369                 return (LIBUSB_ERROR_NOT_SUPPORTED);
 370
 371         usbi_dbg("bConfigurationValue %d", config);
 372
 373         if (ioctl(dpriv->fd, USB_SET_CONFIG, &config) < 0)
 374                 return _errno_to_libusb(errno);
 375
 376         return _cache_active_config_descriptor(handle->dev);
 377 }
 378
 379 int
 380 obsd_claim_interface(struct libusb_device_handle *handle, int iface)
 381 {
 382         struct handle_priv *hpriv = (struct handle_priv *)handle->os_priv;
 383         int i;
 384
 385         for (i = 0; i < USB_MAX_ENDPOINTS; i++)
 386                 hpriv->endpoints[i] = -1;
 387
 388         return (LIBUSB_SUCCESS);
 389 }
 390
 391 int
 392 obsd_release_interface(struct libusb_device_handle *handle, int iface)
 393 {
 394         struct handle_priv *hpriv = (struct handle_priv *)handle->os_priv;
 395         int i;
 396
 397         for (i = 0; i < USB_MAX_ENDPOINTS; i++)
 398                 if (hpriv->endpoints[i] >= 0)
 399                         close(hpriv->endpoints[i]);
 400
 401         return (LIBUSB_SUCCESS);
 402 }
 403
 404 int
 405 obsd_set_interface_altsetting(struct libusb_device_handle *handle, int iface,
 406     int altsetting)
 407 {
 408         struct device_priv *dpriv = (struct device_priv *)handle->dev->os_priv;
 409         struct usb_alt_interface intf;
 410
 411         if (dpriv->devname == NULL)
 412                 return (LIBUSB_ERROR_NOT_SUPPORTED);
 413
 414         usbi_dbg("iface %d, setting %d", iface, altsetting);
 415
 416         memset(&intf, 0, sizeof(intf));
 417
 418         intf.uai_interface_index = iface;
 419         intf.uai_alt_no = altsetting;
 420
 421         if (ioctl(dpriv->fd, USB_SET_ALTINTERFACE, &intf) < 0)
 422                 return _errno_to_libusb(errno);
 423
 424         return (LIBUSB_SUCCESS);
 425 }
 426
 427 int
 428 obsd_clear_halt(struct libusb_device_handle *handle, unsigned char endpoint)
 429 {
 430         struct usb_ctl_request req;
 431         int fd, err;
 432
 433         if ((fd = _bus_open(handle->dev->bus_number)) < 0)
 434                 return _errno_to_libusb(errno);
 435
 436         usbi_dbg("");
 437
 438         req.ucr_addr = handle->dev->device_address;
 439         req.ucr_request.bmRequestType = UT_WRITE_ENDPOINT;
 440         req.ucr_request.bRequest = UR_CLEAR_FEATURE;
 441         USETW(req.ucr_request.wValue, UF_ENDPOINT_HALT);
 442         USETW(req.ucr_request.wIndex, endpoint);
 443         USETW(req.ucr_request.wLength, 0);
 444
 445         if (ioctl(fd, USB_REQUEST, &req) < 0) {
 446                 err = errno;
 447                 close(fd);
 448                 return _errno_to_libusb(err);
 449         }
 450         close(fd);
 451
 452         return (LIBUSB_SUCCESS);
 453 }
 454
 455 int
 456 obsd_reset_device(struct libusb_device_handle *handle)
 457 {
 458         usbi_dbg("");
 459
 460         return (LIBUSB_ERROR_NOT_SUPPORTED);
 461 }
 462
 463 void
 464 obsd_destroy_device(struct libusb_device *dev)
 465 {
 466         struct device_priv *dpriv = (struct device_priv *)dev->os_priv;
 467
 468         usbi_dbg("");
 469
 470         free(dpriv->cdesc);
 471         free(dpriv->devname);
 472 }
 473
 474 int
 475 obsd_submit_transfer(struct usbi_transfer *itransfer)
 476 {
 477         struct libusb_transfer *transfer;
 478         struct handle_priv *hpriv;
 479         int err = 0;
 480
 481         usbi_dbg("");
 482
 483         transfer = USBI_TRANSFER_TO_LIBUSB_TRANSFER(itransfer);
 484         hpriv = (struct handle_priv *)transfer->dev_handle->os_priv;
 485
 486         switch (transfer->type) {
 487         case LIBUSB_TRANSFER_TYPE_CONTROL:
 488                 err = _sync_control_transfer(itransfer);
 489                 break;
 490         case LIBUSB_TRANSFER_TYPE_ISOCHRONOUS:
 491                 if (IS_XFEROUT(transfer)) {
 492                         /* Isochronous write is not supported */
 493                         err = LIBUSB_ERROR_NOT_SUPPORTED;
 494                         break;
 495                 }
 496                 err = _sync_gen_transfer(itransfer);
 497                 break;
 498         case LIBUSB_TRANSFER_TYPE_BULK:
 499         case LIBUSB_TRANSFER_TYPE_INTERRUPT:
 500                 if (IS_XFEROUT(transfer) &&
 501                     transfer->flags & LIBUSB_TRANSFER_ADD_ZERO_PACKET) {
 502                         err = LIBUSB_ERROR_NOT_SUPPORTED;
 503                         break;
 504                 }
 505                 err = _sync_gen_transfer(itransfer);
 506                 break;
 507         }
 508
 509         if (err)
 510                 return (err);
 511
 512         if (write(hpriv->pipe[1], &itransfer, sizeof(itransfer)) < 0)
 513                 return _errno_to_libusb(errno);
 514
 515         return (LIBUSB_SUCCESS);
 516 }
 517
 518 int
 519 obsd_cancel_transfer(struct usbi_transfer *itransfer)
 520 {
 521         usbi_dbg("");
 522
 523         return (LIBUSB_ERROR_NOT_SUPPORTED);
 524 }
 525
 526 void
 527 obsd_clear_transfer_priv(struct usbi_transfer *itransfer)
 528 {
 529         usbi_dbg("");
 530
 531         /* Nothing to do */
 532 }
 533
 534 int
 535 obsd_handle_events(struct libusb_context *ctx, struct pollfd *fds, nfds_t nfds,
 536     int num_ready)
 537 {
 538         struct libusb_device_handle *handle;
 539         struct handle_priv *hpriv = NULL;
 540         struct usbi_transfer *itransfer;
 541         struct pollfd *pollfd;
 542         int i, err = 0;
 543
 544         usbi_dbg("");
 545
 546         pthread_mutex_lock(&ctx->open_devs_lock);
 547         for (i = 0; i < nfds && num_ready > 0; i++) {
 548                 pollfd = &fds[i];
 549
 550                 if (!pollfd->revents)
 551                         continue;
 552
 553                 hpriv = NULL;
 554                 num_ready--;
 555                 list_for_each_entry(handle, &ctx->open_devs, list,
 556                     struct libusb_device_handle) {
 557                         hpriv = (struct handle_priv *)handle->os_priv;
 558
 559                         if (hpriv->pipe[0] == pollfd->fd)
 560                                 break;
 561
 562                         hpriv = NULL;
 563                 }
 564
 565                 if (NULL == hpriv) {
 566                         usbi_dbg("fd %d is not an event pipe!", pollfd->fd);
 567                         err = ENOENT;
 568                         break;
 569                 }
 570
 571                 if (pollfd->revents & POLLERR) {
 572                         usbi_remove_pollfd(HANDLE_CTX(handle), hpriv->pipe[0]);
 573                         usbi_handle_disconnect(handle);
 574                         continue;
 575                 }
 576
 577                 if (read(hpriv->pipe[0], &itransfer, sizeof(itransfer)) < 0) {
 578                         err = errno;
 579                         break;
 580                 }
 581
 582                 if ((err = usbi_handle_transfer_completion(itransfer,
 583                     LIBUSB_TRANSFER_COMPLETED)))
 584                         break;
 585         }
 586         pthread_mutex_unlock(&ctx->open_devs_lock);
 587
 588         if (err)
 589                 return _errno_to_libusb(err);
 590
 591         return (LIBUSB_SUCCESS);
 592 }
 593
 594 int
 595 obsd_clock_gettime(int clkid, struct timespec *tp)
 596 {
 597         usbi_dbg("clock %d", clkid);
 598
 599         if (clkid == USBI_CLOCK_REALTIME)
 600                 return clock_gettime(CLOCK_REALTIME, tp);
 601
 602         if (clkid == USBI_CLOCK_MONOTONIC)
 603                 return clock_gettime(CLOCK_MONOTONIC, tp);
 604
 605         return (LIBUSB_ERROR_INVALID_PARAM);
 606 }
 607
 608 int
 609 _errno_to_libusb(int err)
 610 {
 611         usbi_dbg("error: %s (%d)", strerror(err), err);
 612
 613         switch (err) {
 614         case EIO:
 615                 return (LIBUSB_ERROR_IO);
 616         case EACCES:
 617                 return (LIBUSB_ERROR_ACCESS);
 618         case ENOENT:
 619                 return (LIBUSB_ERROR_NO_DEVICE);
 620         case ENOMEM:
 621                 return (LIBUSB_ERROR_NO_MEM);
 622         case ETIMEDOUT:
 623                 return (LIBUSB_ERROR_TIMEOUT);
 624         }
 625
 626         return (LIBUSB_ERROR_OTHER);
 627 }
 628
 629 int
 630 _cache_active_config_descriptor(struct libusb_device *dev)
 631 {
 632         struct device_priv *dpriv = (struct device_priv *)dev->os_priv;
 633         struct usb_device_cdesc udc;
 634         struct usb_device_fdesc udf;
 635         unsigned char* buf;
 636         int fd, len, err;
 637
 638         if ((fd = _bus_open(dev->bus_number)) < 0)
 639                 return _errno_to_libusb(errno);
 640
 641         usbi_dbg("fd %d, addr %d", fd, dev->device_address);
 642
 643         udc.udc_bus = dev->bus_number;
 644         udc.udc_addr = dev->device_address;
 645         udc.udc_config_index = USB_CURRENT_CONFIG_INDEX;
 646         if (ioctl(fd, USB_DEVICE_GET_CDESC, &udc) < 0) {
 647                 err = errno;
 648                 close(fd);
 649                 return _errno_to_libusb(errno);
 650         }
 651
 652         usbi_dbg("active bLength %d", udc.udc_desc.bLength);
 653
 654         len = UGETW(udc.udc_desc.wTotalLength);
 655         buf = malloc(len);
 656         if (buf == NULL)
 657                 return (LIBUSB_ERROR_NO_MEM);
 658
 659         udf.udf_bus = dev->bus_number;
 660         udf.udf_addr = dev->device_address;
 661         udf.udf_config_index = udc.udc_config_index;
 662         udf.udf_size = len;
 663         udf.udf_data = buf;
 664
 665         usbi_dbg("index %d, len %d", udf.udf_config_index, len);
 666
 667         if (ioctl(fd, USB_DEVICE_GET_FDESC, &udf) < 0) {
 668                 err = errno;
 669                 close(fd);
 670                 free(buf);
 671                 return _errno_to_libusb(err);
 672         }
 673         close(fd);
 674
 675         if (dpriv->cdesc)
 676                 free(dpriv->cdesc);
 677         dpriv->cdesc = buf;
 678
 679         return (LIBUSB_SUCCESS);
 680 }
 681
 682 int
 683 _sync_control_transfer(struct usbi_transfer *itransfer)
 684 {
 685         struct libusb_transfer *transfer;
 686         struct libusb_control_setup *setup;
 687         struct device_priv *dpriv;
 688         struct usb_ctl_request req;
 689
 690         transfer = USBI_TRANSFER_TO_LIBUSB_TRANSFER(itransfer);
 691         dpriv = (struct device_priv *)transfer->dev_handle->dev->os_priv;
 692         setup = (struct libusb_control_setup *)transfer->buffer;
 693
 694         usbi_dbg("type %x request %x value %x index %d length %d timeout %d",
 695             setup->bmRequestType, setup->bRequest,
 696             libusb_le16_to_cpu(setup->wValue),
 697             libusb_le16_to_cpu(setup->wIndex),
 698             libusb_le16_to_cpu(setup->wLength), transfer->timeout);
 699
 700         req.ucr_addr = transfer->dev_handle->dev->device_address;
 701         req.ucr_request.bmRequestType = setup->bmRequestType;
 702         req.ucr_request.bRequest = setup->bRequest;
 703         /* Don't use USETW, libusbx already deals with the endianness */
 704         (*(uint16_t *)req.ucr_request.wValue) = setup->wValue;
 705         (*(uint16_t *)req.ucr_request.wIndex) = setup->wIndex;
 706         (*(uint16_t *)req.ucr_request.wLength) = setup->wLength;
 707         req.ucr_data = transfer->buffer + LIBUSB_CONTROL_SETUP_SIZE;
 708
 709         if ((transfer->flags & LIBUSB_TRANSFER_SHORT_NOT_OK) == 0)
 710                 req.ucr_flags = USBD_SHORT_XFER_OK;
 711
 712         if (dpriv->devname == NULL) {
 713                 /*
 714                  * XXX If the device is not attached to ugen(4) it is
 715                  * XXX still possible to submit a control transfer but
 716                  * XXX with the default timeout only.
 717                  */
 718                 int fd, err;
 719
 720                 if ((fd = _bus_open(transfer->dev_handle->dev->bus_number)) < 0)
 721                         return _errno_to_libusb(errno);
 722
 723                 if ((ioctl(fd, USB_REQUEST, &req)) < 0) {
 724                         err = errno;
 725                         close(fd);
 726                         return _errno_to_libusb(err);
 727                 }
 728                 close(fd);
 729         } else {
 730                 if ((ioctl(dpriv->fd, USB_SET_TIMEOUT, &transfer->timeout)) < 0)
 731                         return _errno_to_libusb(errno);
 732
 733                 if ((ioctl(dpriv->fd, USB_DO_REQUEST, &req)) < 0)
 734                         return _errno_to_libusb(errno);
 735         }
 736
 737         itransfer->transferred = req.ucr_actlen;
 738
 739         usbi_dbg("transferred %d", itransfer->transferred);
 740
 741         return (0);
 742 }
 743
 744 int
 745 _access_endpoint(struct libusb_transfer *transfer)
 746 {
 747         struct handle_priv *hpriv;
 748         struct device_priv *dpriv;
 749         char devnode[16];
 750         int fd, endpt;
 751         mode_t mode;
 752
 753         hpriv = (struct handle_priv *)transfer->dev_handle->os_priv;
 754         dpriv = (struct device_priv *)transfer->dev_handle->dev->os_priv;
 755
 756         endpt = UE_GET_ADDR(transfer->endpoint);
 757         mode = IS_XFERIN(transfer) ? O_RDONLY : O_WRONLY;
 758
 759         usbi_dbg("endpoint %d mode %d", endpt, mode);
 760
 761         if (hpriv->endpoints[endpt] < 0) {
 762                 /* Pick the right endpoint node */
 763                 snprintf(devnode, sizeof(devnode), DEVPATH "%s.%02d",
 764                     dpriv->devname, endpt);
 765
 766                 /* We may need to read/write to the same endpoint later. */
 767                 if (((fd = open(devnode, O_RDWR)) < 0) && (errno == ENXIO))
 768                         if ((fd = open(devnode, mode)) < 0)
 769                                 return (-1);
 770
 771                 hpriv->endpoints[endpt] = fd;
 772         }
 773
 774         return (hpriv->endpoints[endpt]);
 775 }
 776
 777 int
 778 _sync_gen_transfer(struct usbi_transfer *itransfer)
 779 {
 780         struct libusb_transfer *transfer;
 781         struct device_priv *dpriv;
 782         int fd, nr = 1;
 783
 784         transfer = USBI_TRANSFER_TO_LIBUSB_TRANSFER(itransfer);
 785         dpriv = (struct device_priv *)transfer->dev_handle->dev->os_priv;
 786
 787         if (dpriv->devname == NULL)
 788                 return (LIBUSB_ERROR_NOT_SUPPORTED);
 789
 790         /*
 791          * Bulk, Interrupt or Isochronous transfer depends on the
 792          * endpoint and thus the node to open.
 793          */
 794         if ((fd = _access_endpoint(transfer)) < 0)
 795                 return _errno_to_libusb(errno);
 796
 797         if ((ioctl(fd, USB_SET_TIMEOUT, &transfer->timeout)) < 0)
 798                 return _errno_to_libusb(errno);
 799
 800         if (IS_XFERIN(transfer)) {
 801                 if ((transfer->flags & LIBUSB_TRANSFER_SHORT_NOT_OK) == 0)
 802                         if ((ioctl(fd, USB_SET_SHORT_XFER, &nr)) < 0)
 803                                 return _errno_to_libusb(errno);
 804
 805                 nr = read(fd, transfer->buffer, transfer->length);
 806         } else {
 807                 nr = write(fd, transfer->buffer, transfer->length);
 808         }
 809
 810         if (nr < 0)
 811                 return _errno_to_libusb(errno);
 812
 813         itransfer->transferred = nr;
 814
 815         return (0);
 816 }
 817
 818 int
 819 _bus_open(int number)
 820 {
 821         char busnode[16];
 822
 823         snprintf(busnode, sizeof(busnode), USBDEV "%d", number);
 824
 825         return open(busnode, O_RDWR);
 826 }