GOSTSec
/
sgminer
mirror of https://github.com/GOSTSec/sgminer
1
0
Fork 0
Code Issues Releases Wiki Activity
OpenCL GPU miner
You can not select more than 25 topics Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
5593 Commits
12 Branches
10 Tags
44 MiB
 
 
 
 
 
Tree: 2e11a50484
Branches Tags
${ item.name }
Create tag ${ searchTerm }
Create branch ${ searchTerm }
from '2e11a50484'
${ noResults }
sgminer/compat/libusb-1.0/libusb/os/linux_usbfs.c

2609 lines
71 KiB
Raw Blame History

/* -*- Mode: C; c-basic-offset:8 ; indent-tabs-mode:t -*- */
/*
* Linux usbfs backend for libusb
* Copyright (C) 2007-2009 Daniel Drake <dsd@gentoo.org>
* Copyright (c) 2001 Johannes Erdfelt <johannes@erdfelt.com>
* Copyright (c) 2013 Nathan Hjelm <hjelmn@mac.com>
*
* This library is free software; you can redistribute it and/or
* modify it under the terms of the GNU Lesser General Public
* License as published by the Free Software Foundation; either
* version 2.1 of the License, or (at your option) any later version.
*
* This library is distributed in the hope that it will be useful,
* but WITHOUT ANY WARRANTY; without even the implied warranty of
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
* Lesser General Public License for more details.
*
* You should have received a copy of the GNU Lesser General Public
* License along with this library; if not, write to the Free Software
* Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA
*/
#include <config.h>
#include <ctype.h>
#include <dirent.h>
#include <errno.h>
#include <fcntl.h>
#include <poll.h>
#include <stdio.h>
#include <stdlib.h>
#include <string.h>
#include <sys/ioctl.h>
#include <sys/stat.h>
#include <sys/types.h>
#include <sys/utsname.h>
#include <unistd.h>
#include "libusb.h"
#include "libusbi.h"
#include "linux_usbfs.h"
/* sysfs vs usbfs:
* opening a usbfs node causes the device to be resumed, so we attempt to
* avoid this during enumeration.
*
* sysfs allows us to read the kernel's in-memory copies of device descriptors
* and so forth, avoiding the need to open the device:
* - The binary "descriptors" file was added in 2.6.23.
* - The "busnum" file was added in 2.6.22
* - The "devnum" file has been present since pre-2.6.18
* - the "bConfigurationValue" file has been present since pre-2.6.18
*
* If we have bConfigurationValue, busnum, and devnum, then we can determine
* the active configuration without having to open the usbfs node in RDWR mode.
* We assume this is the case if we see the busnum file (indicates 2.6.22+).
* The busnum file is important as that is the only way we can relate sysfs
* devices to usbfs nodes.
*
* If we also have descriptors, we can obtain the device descriptor and active
* configuration without touching usbfs at all.
*
* The descriptors file originally only contained the active configuration
* descriptor alongside the device descriptor, but all configurations are
* included as of Linux 2.6.26.
*/
/* endianness for multi-byte fields:
*
* Descriptors exposed by usbfs have the multi-byte fields in the device
* descriptor as host endian. Multi-byte fields in the other descriptors are
* bus-endian. The kernel documentation says otherwise, but it is wrong.
*/
const char *usbfs_path = NULL;
/* use usbdev*.* device names in /dev instead of the usbfs bus directories */
static int usbdev_names = 0;
/* Linux 2.6.32 adds support for a bulk continuation URB flag. this basically
* allows us to mark URBs as being part of a specific logical transfer when
* we submit them to the kernel. then, on any error except a cancellation, all
* URBs within that transfer will be cancelled and no more URBs will be
* accepted for the transfer, meaning that no more data can creep in.
*
* The BULK_CONTINUATION flag must be set on all URBs within a bulk transfer
* (in either direction) except the first.
* For IN transfers, we must also set SHORT_NOT_OK on all URBs except the
* last; it means that the kernel should treat a short reply as an error.
* For OUT transfers, SHORT_NOT_OK must not be set. it isn't needed (OUT
* transfers can't be short unless there's already some sort of error), and
* setting this flag is disallowed (a kernel with USB debugging enabled will
* reject such URBs).
*/
static int supports_flag_bulk_continuation = -1;
/* Linux 2.6.31 fixes support for the zero length packet URB flag. This
* allows us to mark URBs that should be followed by a zero length data
* packet, which can be required by device- or class-specific protocols.
*/
static int supports_flag_zero_packet = -1;
/* clock ID for monotonic clock, as not all clock sources are available on all
* systems. appropriate choice made at initialization time. */
static clockid_t monotonic_clkid = -1;
/* do we have a busnum to relate devices? this also implies that we can read
* the active configuration through bConfigurationValue */
static int sysfs_can_relate_devices = 0;
/* do we have a descriptors file? */
static int sysfs_has_descriptors = 0;
/* how many times have we initted (and not exited) ? */
static volatile int init_count = 0;
/* lock for init_count */
static pthread_mutex_t hotplug_lock = PTHREAD_MUTEX_INITIALIZER;
static int linux_start_event_monitor(void);
static int linux_stop_event_monitor(void);
static int linux_scan_devices(struct libusb_context *ctx);
#if !defined(USE_UDEV)
static int linux_default_scan_devices (struct libusb_context *ctx);
#endif
struct linux_device_priv {
char *sysfs_dir;
unsigned char *dev_descriptor;
unsigned char *config_descriptor;
};
struct linux_device_handle_priv {
int fd;
uint32_t caps;
};
enum reap_action {
NORMAL = 0,
/* submission failed after the first URB, so await cancellation/completion
* of all the others */
SUBMIT_FAILED,
/* cancelled by user or timeout */
CANCELLED,
/* completed multi-URB transfer in non-final URB */
COMPLETED_EARLY,
/* one or more urbs encountered a low-level error */
ERROR,
};
struct linux_transfer_priv {
union {
struct usbfs_urb *urbs;
struct usbfs_urb **iso_urbs;
};
enum reap_action reap_action;
int num_urbs;
int num_retired;
enum libusb_transfer_status reap_status;
/* next iso packet in user-supplied transfer to be populated */
int iso_packet_offset;
};
static void _get_usbfs_path(struct libusb_device *dev, char *path)
{
if (usbdev_names)
snprintf(path, PATH_MAX, "%s/usbdev%d.%d",
usbfs_path, dev->bus_number, dev->device_address);
else
snprintf(path, PATH_MAX, "%s/%03d/%03d",
usbfs_path, dev->bus_number, dev->device_address);
}
static struct linux_device_priv *_device_priv(struct libusb_device *dev)
{
return (struct linux_device_priv *) dev->os_priv;
}
static struct linux_device_handle_priv *_device_handle_priv(
struct libusb_device_handle *handle)
{
return (struct linux_device_handle_priv *) handle->os_priv;
}
/* check dirent for a /dev/usbdev%d.%d name
* optionally return bus/device on success */
static int _is_usbdev_entry(struct dirent *entry, int *bus_p, int *dev_p)
{
int busnum, devnum;
if (sscanf(entry->d_name, "usbdev%d.%d", &busnum, &devnum) != 2)
return 0;
usbi_dbg("found: %s", entry->d_name);
if (bus_p != NULL)
*bus_p = busnum;
if (dev_p != NULL)
*dev_p = devnum;
return 1;
}
static int check_usb_vfs(const char *dirname)
{
DIR *dir;
struct dirent *entry;
int found = 0;
dir = opendir(dirname);
if (!dir)
return 0;
while ((entry = readdir(dir)) != NULL) {
if (entry->d_name[0] == '.')
continue;
/* We assume if we find any files that it must be the right place */
found = 1;
break;
}
closedir(dir);
return found;
}
static const char *find_usbfs_path(void)
{
const char *path = "/dev/bus/usb";
const char *ret = NULL;
if (check_usb_vfs(path)) {
ret = path;
} else {
path = "/proc/bus/usb";
if (check_usb_vfs(path))
ret = path;
}
/* look for /dev/usbdev*.* if the normal places fail */
if (ret == NULL) {
struct dirent *entry;
DIR *dir;
path = "/dev";
dir = opendir(path);
if (dir != NULL) {
while ((entry = readdir(dir)) != NULL) {
if (_is_usbdev_entry(entry, NULL, NULL)) {
/* found one; that's enough */
ret = path;
usbdev_names = 1;
break;
}
}
closedir(dir);
}
}
if (ret != NULL)
usbi_dbg("found usbfs at %s", ret);
return ret;
}
/* the monotonic clock is not usable on all systems (e.g. embedded ones often
* seem to lack it). fall back to REALTIME if we have to. */
static clockid_t find_monotonic_clock(void)
{
#ifdef CLOCK_MONOTONIC
struct timespec ts;
int r;
/* Linux 2.6.28 adds CLOCK_MONOTONIC_RAW but we don't use it
* because it's not available through timerfd */
r = clock_gettime(CLOCK_MONOTONIC, &ts);
if (r == 0)
return CLOCK_MONOTONIC;
usbi_dbg("monotonic clock doesn't work, errno %d", errno);
#endif
return CLOCK_REALTIME;
}
static int kernel_version_ge(int major, int minor, int sublevel)
{
struct utsname uts;
int atoms, kmajor, kminor, ksublevel;
if (uname(&uts) < 0)
return -1;
atoms = sscanf(uts.release, "%d.%d.%d", &kmajor, &kminor, &ksublevel);
if (atoms < 1)
return -1;
if (kmajor > major)
return 1;
if (kmajor < major)
return 0;
/* kmajor == major */
if (atoms < 2)
return 0 == minor && 0 == sublevel;
if (kminor > minor)
return 1;
if (kminor < minor)
return 0;
/* kminor == minor */
if (atoms < 3)
return 0 == sublevel;
return ksublevel >= sublevel;
}
/* Return 1 if filename exists inside dirname in sysfs.
SYSFS_DEVICE_PATH is assumed to be the beginning of the path. */
static int sysfs_has_file(const char *dirname, const char *filename)
{
struct stat statbuf;
char path[PATH_MAX];
int r;
snprintf(path, PATH_MAX, "%s/%s/%s", SYSFS_DEVICE_PATH, dirname, filename);
r = stat(path, &statbuf);
if (r == 0 && S_ISREG(statbuf.st_mode))
return 1;
return 0;
}
static int op_init(struct libusb_context *ctx)
{
struct stat statbuf;
int r;
usbfs_path = find_usbfs_path();
if (!usbfs_path) {
usbi_err(ctx, "could not find usbfs");
return LIBUSB_ERROR_OTHER;
}
if (monotonic_clkid == -1)
monotonic_clkid = find_monotonic_clock();
if (supports_flag_bulk_continuation == -1) {
/* bulk continuation URB flag available from Linux 2.6.32 */
supports_flag_bulk_continuation = kernel_version_ge(2,6,32);
if (supports_flag_bulk_continuation == -1) {
usbi_err(ctx, "error checking for bulk continuation support");
return LIBUSB_ERROR_OTHER;
}
}
if (supports_flag_bulk_continuation)
usbi_dbg("bulk continuation flag supported");
if (-1 == supports_flag_zero_packet) {
/* zero length packet URB flag fixed since Linux 2.6.31 */
supports_flag_zero_packet = kernel_version_ge(2,6,31);
if (-1 == supports_flag_zero_packet) {
usbi_err(ctx, "error checking for zero length packet support");
return LIBUSB_ERROR_OTHER;
}
}
if (supports_flag_zero_packet)
usbi_dbg("zero length packet flag supported");
r = stat(SYSFS_DEVICE_PATH, &statbuf);
if (r == 0 && S_ISDIR(statbuf.st_mode)) {
DIR *devices = opendir(SYSFS_DEVICE_PATH);
struct dirent *entry;
usbi_dbg("found usb devices in sysfs");
if (!devices) {
usbi_err(ctx, "opendir devices failed errno=%d", errno);
return LIBUSB_ERROR_IO;
}
/* Make sure sysfs supports all the required files. If it
* does not, then usbfs will be used instead. Determine
* this by looping through the directories in
* SYSFS_DEVICE_PATH. With the assumption that there will
* always be subdirectories of the name usbN (usb1, usb2,
* etc) representing the root hubs, check the usbN
* subdirectories to see if they have all the needed files.
* This algorithm uses the usbN subdirectories (root hubs)
* because a device disconnection will cause a race
* condition regarding which files are available, sometimes
* causing an incorrect result. The root hubs are used
* because it is assumed that they will always be present.
* See the "sysfs vs usbfs" comment at the top of this file
* for more details. */
while ((entry = readdir(devices))) {
int has_busnum=0, has_devnum=0, has_descriptors=0;
int has_configuration_value=0;
/* Only check the usbN directories. */
if (strncmp(entry->d_name, "usb", 3) != 0)
continue;
/* Check for the files libusb needs from sysfs. */
has_busnum = sysfs_has_file(entry->d_name, "busnum");
has_devnum = sysfs_has_file(entry->d_name, "devnum");
has_descriptors = sysfs_has_file(entry->d_name, "descriptors");
has_configuration_value = sysfs_has_file(entry->d_name, "bConfigurationValue");
if (has_busnum && has_devnum && has_configuration_value)
sysfs_can_relate_devices = 1;
if (has_descriptors)
sysfs_has_descriptors = 1;
/* Only need to check until we've found ONE device which
has all the attributes. */
if (sysfs_has_descriptors && sysfs_can_relate_devices)
break;
}
closedir(devices);
/* Only use sysfs descriptors if the rest of
sysfs will work for libusb. */
if (!sysfs_can_relate_devices)
sysfs_has_descriptors = 0;
} else {
usbi_dbg("sysfs usb info not available");
sysfs_has_descriptors = 0;
sysfs_can_relate_devices = 0;
}
pthread_mutex_lock(&hotplug_lock);
if (!init_count++) {
/* start up hotplug event handler */
r = linux_start_event_monitor();
if (LIBUSB_SUCCESS != r) {
usbi_err(ctx, "error starting hotplug event monitor");
return r;
}
}
pthread_mutex_unlock(&hotplug_lock);
r = linux_scan_devices(ctx);
if (LIBUSB_SUCCESS != r) {
return r;
}
return r;
}
static void op_exit(void)
{
if (!init_count) {
/* should not happen */
return;
}
pthread_mutex_lock(&hotplug_lock);
if (!--init_count) {
/* tear down event handler */
(void)linux_stop_event_monitor();
}
pthread_mutex_unlock(&hotplug_lock);
}
static int linux_start_event_monitor(void)
{
#if defined(USE_UDEV)
return linux_udev_start_event_monitor();
#else
return linux_netlink_start_event_monitor();
#endif
}
static int linux_stop_event_monitor(void)
{
#if defined(USE_UDEV)
return linux_udev_stop_event_monitor();
#else
return linux_netlink_stop_event_monitor();
#endif
}
static int linux_scan_devices(struct libusb_context *ctx)
{
#if defined(USE_UDEV)
return linux_udev_scan_devices(ctx);
#else
return linux_default_scan_devices(ctx);
#endif
}
static int usbfs_get_device_descriptor(struct libusb_device *dev,
unsigned char *buffer)
{
struct linux_device_priv *priv = _device_priv(dev);
/* return cached copy */
memcpy(buffer, priv->dev_descriptor, DEVICE_DESC_LENGTH);
return 0;
}
static int _open_sysfs_attr(struct libusb_device *dev, const char *attr)
{
struct linux_device_priv *priv = _device_priv(dev);
char filename[PATH_MAX];
int fd;
snprintf(filename, PATH_MAX, "%s/%s/%s",
SYSFS_DEVICE_PATH, priv->sysfs_dir, attr);
fd = open(filename, O_RDONLY);
if (fd < 0) {
usbi_err(DEVICE_CTX(dev),
"open %s failed ret=%d errno=%d", filename, fd, errno);
return LIBUSB_ERROR_IO;
}
return fd;
}
/* Note only suitable for attributes which always read >= 0, < 0 is error */
static int __read_sysfs_attr(struct libusb_context *ctx,
const char *devname, const char *attr)
{
char filename[PATH_MAX];
FILE *f;
int r, value;
snprintf(filename, PATH_MAX, "%s/%s/%s", SYSFS_DEVICE_PATH,
devname, attr);
f = fopen(filename, "r");
if (f == NULL) {
if (errno == ENOENT) {
/* File doesn't exist. Assume the device has been
disconnected (see trac ticket #70). */
return LIBUSB_ERROR_NO_DEVICE;
}
usbi_err(ctx, "open %s failed errno=%d", filename, errno);
return LIBUSB_ERROR_IO;
}
r = fscanf(f, "%d", &value);
fclose(f);
if (r != 1) {
usbi_err(ctx, "fscanf %s returned %d, errno=%d", attr, r, errno);
return LIBUSB_ERROR_NO_DEVICE; /* For unplug race (trac #70) */
}
if (value < 0) {
usbi_err(ctx, "%s contains a negative value", filename);
return LIBUSB_ERROR_IO;
}
return value;
}
static int sysfs_get_device_descriptor(struct libusb_device *dev,
unsigned char *buffer)
{
int fd;
ssize_t r;
/* sysfs provides access to an in-memory copy of the device descriptor,
* so we use that rather than keeping our own copy */
fd = _open_sysfs_attr(dev, "descriptors");
if (fd < 0)
return fd;
r = read(fd, buffer, DEVICE_DESC_LENGTH);;
close(fd);
if (r < 0) {
usbi_err(DEVICE_CTX(dev), "read failed, ret=%d errno=%d", fd, errno);
return LIBUSB_ERROR_IO;
} else if (r < DEVICE_DESC_LENGTH) {
usbi_err(DEVICE_CTX(dev), "short read %d/%d", r, DEVICE_DESC_LENGTH);
return LIBUSB_ERROR_IO;
}
return 0;
}
static int op_get_device_descriptor(struct libusb_device *dev,
unsigned char *buffer, int *host_endian)
{
if (sysfs_has_descriptors) {
*host_endian = 0;
return sysfs_get_device_descriptor(dev, buffer);
} else {
*host_endian = 1;
return usbfs_get_device_descriptor(dev, buffer);
}
}
static int usbfs_get_active_config_descriptor(struct libusb_device *dev,
unsigned char *buffer, size_t len)
{
struct linux_device_priv *priv = _device_priv(dev);
if (!priv->config_descriptor)
return LIBUSB_ERROR_NOT_FOUND; /* device is unconfigured */
/* retrieve cached copy */
memcpy(buffer, priv->config_descriptor, len);
return 0;
}
/* read the bConfigurationValue for a device */
static int sysfs_get_active_config(struct libusb_device *dev, int *config)
{
char *endptr;
char tmp[4] = {0, 0, 0, 0};
long num;
int fd;
ssize_t r;
fd = _open_sysfs_attr(dev, "bConfigurationValue");
if (fd < 0)
return fd;
r = read(fd, tmp, sizeof(tmp));
close(fd);
if (r < 0) {
usbi_err(DEVICE_CTX(dev),
"read bConfigurationValue failed ret=%d errno=%d", r, errno);
return LIBUSB_ERROR_IO;
} else if (r == 0) {
usbi_dbg("device unconfigured");
*config = -1;
return 0;
}
if (tmp[sizeof(tmp) - 1] != 0) {
usbi_err(DEVICE_CTX(dev), "not null-terminated?");
return LIBUSB_ERROR_IO;
} else if (tmp[0] == 0) {
usbi_err(DEVICE_CTX(dev), "no configuration value?");
return LIBUSB_ERROR_IO;
}
num = strtol(tmp, &endptr, 10);
if (endptr == tmp) {
usbi_err(DEVICE_CTX(dev), "error converting '%s' to integer", tmp);
return LIBUSB_ERROR_IO;
}
*config = (int) num;
return 0;
}
/* takes a usbfs/descriptors fd seeked to the start of a configuration, and
* seeks to the next one. */
static int seek_to_next_config(struct libusb_context *ctx, int fd,
int host_endian)
{
struct libusb_config_descriptor config;
unsigned char tmp[6];
off_t off;
ssize_t r;
/* read first 6 bytes of descriptor */
r = read(fd, tmp, sizeof(tmp));
if (r < 0) {
usbi_err(ctx, "read failed ret=%d errno=%d", r, errno);
return LIBUSB_ERROR_IO;
} else if (r < (ssize_t)sizeof(tmp)) {
usbi_err(ctx, "short descriptor read %d/%d", r, sizeof(tmp));
return LIBUSB_ERROR_IO;
}
/* seek forward to end of config */
usbi_parse_descriptor(tmp, "bbwbb", &config, host_endian);
off = lseek(fd, config.wTotalLength - sizeof(tmp), SEEK_CUR);
if (off < 0) {
usbi_err(ctx, "seek failed ret=%d errno=%d", off, errno);
return LIBUSB_ERROR_IO;
}
return 0;
}
static int sysfs_get_active_config_descriptor(struct libusb_device *dev,
unsigned char *buffer, size_t len)
{
int fd;
ssize_t r;
off_t off;
int to_copy;
int config;
unsigned char tmp[6];
r = sysfs_get_active_config(dev, &config);
if (r < 0)
return r;
if (config == -1)
return LIBUSB_ERROR_NOT_FOUND;
usbi_dbg("active configuration %d", config);
/* sysfs provides access to an in-memory copy of the device descriptor,
* so we use that rather than keeping our own copy */
fd = _open_sysfs_attr(dev, "descriptors");
if (fd < 0)
return fd;
/* device might have been unconfigured since we read bConfigurationValue,
* so first check that there is any config descriptor data at all... */
off = lseek(fd, 0, SEEK_END);
if (off < 1) {
usbi_err(DEVICE_CTX(dev), "end seek failed, ret=%d errno=%d",
off, errno);
close(fd);
return LIBUSB_ERROR_IO;
} else if (off == DEVICE_DESC_LENGTH) {
close(fd);
return LIBUSB_ERROR_NOT_FOUND;
}
off = lseek(fd, DEVICE_DESC_LENGTH, SEEK_SET);
if (off < 0) {
usbi_err(DEVICE_CTX(dev), "seek failed, ret=%d errno=%d", off, errno);
close(fd);
return LIBUSB_ERROR_IO;
}
/* unbounded loop: we expect the descriptor to be present under all
* circumstances */
while (1) {
r = read(fd, tmp, sizeof(tmp));
if (r < 0) {
usbi_err(DEVICE_CTX(dev), "read failed, ret=%d errno=%d",
fd, errno);
return LIBUSB_ERROR_IO;
} else if (r < (ssize_t)sizeof(tmp)) {
usbi_err(DEVICE_CTX(dev), "short read %d/%d", r, sizeof(tmp));
return LIBUSB_ERROR_IO;
}
/* check bConfigurationValue */
if (tmp[5] == config)
break;
/* try the next descriptor */
off = lseek(fd, 0 - sizeof(tmp), SEEK_CUR);
if (off < 0)
return LIBUSB_ERROR_IO;
r = seek_to_next_config(DEVICE_CTX(dev), fd, 0);
if (r < 0)
return r;
}
to_copy = (len < sizeof(tmp)) ? len : sizeof(tmp);
memcpy(buffer, tmp, to_copy);
if (len > sizeof(tmp)) {
r = read(fd, buffer + sizeof(tmp), len - sizeof(tmp));
if (r < 0) {
usbi_err(DEVICE_CTX(dev), "read failed, ret=%d errno=%d",
fd, errno);
r = LIBUSB_ERROR_IO;
} else if (r == 0) {
usbi_dbg("device is unconfigured");
r = LIBUSB_ERROR_NOT_FOUND;
} else if ((size_t)r < len - sizeof(tmp)) {
usbi_err(DEVICE_CTX(dev), "short read %d/%d", r, len);
r = LIBUSB_ERROR_IO;
}
} else {
r = 0;
}
close(fd);
return r;
}
int linux_get_device_address (struct libusb_context *ctx, int detached,
uint8_t *busnum, uint8_t *devaddr,
const char *dev_node, const char *sys_name)
{
int retbus, retdev;
usbi_dbg("getting address for device: %s detached: %d",
sys_name, detached);
/* can't use sysfs to read the bus and device number if the
device has been detached */
if (!sysfs_can_relate_devices || detached || NULL == sys_name) {
if (NULL == dev_node) {
return LIBUSB_ERROR_OTHER;
}
/* will this work with all supported kernel versions? */
if (!strncmp(dev_node, "/dev/bus/usb", 12)) {
sscanf (dev_node, "/dev/bus/usb/%hhd/%hhd", busnum, devaddr);
} else if (!strncmp(dev_node, "/proc/bus/usb", 13)) {
sscanf (dev_node, "/proc/bus/usb/%hhd/%hhd", busnum, devaddr);
}
return LIBUSB_SUCCESS;
}
usbi_dbg("scan %s", sys_name);
*busnum = retbus = __read_sysfs_attr(ctx, sys_name, "busnum");
if (retbus < 0)
return retbus;
*devaddr = retdev = __read_sysfs_attr(ctx, sys_name, "devnum");
if (retdev < 0)
return retdev;
usbi_dbg("bus=%d dev=%d", *busnum, *devaddr);
if (retbus > 255 || retdev > 255)
return LIBUSB_ERROR_INVALID_PARAM;
return LIBUSB_SUCCESS;
}
static int op_get_active_config_descriptor(struct libusb_device *dev,
unsigned char *buffer, size_t len, int *host_endian)
{
*host_endian = *host_endian;
if (sysfs_has_descriptors) {
return sysfs_get_active_config_descriptor(dev, buffer, len);
} else {
return usbfs_get_active_config_descriptor(dev, buffer, len);
}
}
/* takes a usbfs fd, attempts to find the requested config and copy a certain
* amount of it into an output buffer. */
static int get_config_descriptor(struct libusb_context *ctx, int fd,
uint8_t config_index, unsigned char *buffer, size_t len)
{
off_t off;
ssize_t r;
off = lseek(fd, DEVICE_DESC_LENGTH, SEEK_SET);
if (off < 0) {
usbi_err(ctx, "seek failed ret=%d errno=%d", off, errno);
return LIBUSB_ERROR_IO;
}
/* might need to skip some configuration descriptors to reach the
* requested configuration */
while (config_index > 0) {
r = seek_to_next_config(ctx, fd, 1);
if (r < 0)
return r;
config_index--;
}
/* read the rest of the descriptor */
r = read(fd, buffer, len);
if (r < 0) {
usbi_err(ctx, "read failed ret=%d errno=%d", r, errno);
return LIBUSB_ERROR_IO;
} else if ((size_t)r < len) {
usbi_err(ctx, "short output read %d/%d", r, len);
return LIBUSB_ERROR_IO;
}
return 0;
}
static int op_get_config_descriptor(struct libusb_device *dev,
uint8_t config_index, unsigned char *buffer, size_t len, int *host_endian)
{
char filename[PATH_MAX];
int fd;
int r;
*host_endian = *host_endian;
/* always read from usbfs: sysfs only has the active descriptor
* this will involve waking the device up, but oh well! */
/* FIXME: the above is no longer true, new kernels have all descriptors
* in the descriptors file. but its kinda hard to detect if the kernel
* is sufficiently new. */
_get_usbfs_path(dev, filename);
fd = open(filename, O_RDONLY);
if (fd < 0) {
usbi_err(DEVICE_CTX(dev),
"open '%s' failed, ret=%d errno=%d", filename, fd, errno);
return LIBUSB_ERROR_IO;
}
r = get_config_descriptor(DEVICE_CTX(dev), fd, config_index, buffer, len);
close(fd);
return r;
}
/* cache the active config descriptor in memory. a value of -1 means that
* we aren't sure which one is active, so just assume the first one.
* only for usbfs. */
static int cache_active_config(struct libusb_device *dev, int fd,
int active_config)
{
struct linux_device_priv *priv = _device_priv(dev);
struct libusb_config_descriptor config;
unsigned char tmp[8];
unsigned char *buf;
int idx;
int r;
if (active_config == -1) {
idx = 0;
} else {
r = usbi_get_config_index_by_value(dev, active_config, &idx);
if (r < 0)
return r;
if (idx == -1)
return LIBUSB_ERROR_NOT_FOUND;
}
r = get_config_descriptor(DEVICE_CTX(dev), fd, idx, tmp, sizeof(tmp));
if (r < 0) {
usbi_err(DEVICE_CTX(dev), "first read error %d", r);
return r;
}
usbi_parse_descriptor(tmp, "bbw", &config, 0);
buf = malloc(config.wTotalLength);
if (!buf)
return LIBUSB_ERROR_NO_MEM;
r = get_config_descriptor(DEVICE_CTX(dev), fd, idx, buf,
config.wTotalLength);
if (r < 0) {
free(buf);
return r;
}
if (priv->config_descriptor)
free(priv->config_descriptor);
priv->config_descriptor = buf;
return 0;
}
/* send a control message to retrieve active configuration */
static int usbfs_get_active_config(struct libusb_device *dev, int fd)
{
unsigned char active_config = 0;
int r;
struct usbfs_ctrltransfer ctrl = {
.bmRequestType = LIBUSB_ENDPOINT_IN,
.bRequest = LIBUSB_REQUEST_GET_CONFIGURATION,
.wValue = 0,
.wIndex = 0,
.wLength = 1,
.timeout = 1000,
.data = &active_config
};
r = ioctl(fd, IOCTL_USBFS_CONTROL, &ctrl);
if (r < 0) {
if (errno == ENODEV)
return LIBUSB_ERROR_NO_DEVICE;
/* we hit this error path frequently with buggy devices :( */
usbi_warn(DEVICE_CTX(dev),
"get_configuration failed ret=%d errno=%d", r, errno);
return LIBUSB_ERROR_IO;
}
return active_config;
}
static int initialize_device(struct libusb_device *dev, uint8_t busnum,
uint8_t devaddr, const char *sysfs_dir)
{
struct linux_device_priv *priv = _device_priv(dev);
unsigned char *dev_buf;
char path[PATH_MAX];
int fd, speed;
int active_config = 0;
int device_configured = 1;
ssize_t r;
dev->bus_number = busnum;
dev->device_address = devaddr;
if (sysfs_dir) {
priv->sysfs_dir = malloc(strlen(sysfs_dir) + 1);
if (!priv->sysfs_dir)
return LIBUSB_ERROR_NO_MEM;
strcpy(priv->sysfs_dir, sysfs_dir);
/* Note speed can contain 1.5, in this case __read_sysfs_attr
will stop parsing at the '.' and return 1 */
speed = __read_sysfs_attr(DEVICE_CTX(dev), sysfs_dir, "speed");
if (speed >= 0) {
switch (speed) {
case 1: dev->speed = LIBUSB_SPEED_LOW; break;
case 12: dev->speed = LIBUSB_SPEED_FULL; break;
case 480: dev->speed = LIBUSB_SPEED_HIGH; break;
case 5000: dev->speed = LIBUSB_SPEED_SUPER; break;
default:
usbi_warn(DEVICE_CTX(dev), "Unknown device speed: %d Mbps", speed);
}
}
}
if (sysfs_has_descriptors)
return 0;
/* cache device descriptor in memory so that we can retrieve it later
* without waking the device up (op_get_device_descriptor) */
priv->dev_descriptor = NULL;
priv->config_descriptor = NULL;
if (sysfs_can_relate_devices) {
int tmp = sysfs_get_active_config(dev, &active_config);
if (tmp < 0)
return tmp;
if (active_config == -1)
device_configured = 0;
}
_get_usbfs_path(dev, path);
fd = open(path, O_RDWR);
if (fd < 0 && errno == EACCES) {
fd = open(path, O_RDONLY);
/* if we only have read-only access to the device, we cannot
* send a control message to determine the active config. just
* assume the first one is active. */
active_config = -1;
}
if (fd < 0) {
usbi_err(DEVICE_CTX(dev), "open failed, ret=%d errno=%d", fd, errno);
return LIBUSB_ERROR_IO;
}
if (!sysfs_can_relate_devices) {
if (active_config == -1) {
/* if we only have read-only access to the device, we cannot
* send a control message to determine the active config. just
* assume the first one is active. */
usbi_warn(DEVICE_CTX(dev), "access to %s is read-only; cannot "
"determine active configuration descriptor", path);
} else {
active_config = usbfs_get_active_config(dev, fd);
if (active_config == LIBUSB_ERROR_IO) {
/* buggy devices sometimes fail to report their active config.
* assume unconfigured and continue the probing */
usbi_warn(DEVICE_CTX(dev), "couldn't query active "
"configuration, assumung unconfigured");
device_configured = 0;
} else if (active_config < 0) {
close(fd);
return active_config;
} else if (active_config == 0) {
/* some buggy devices have a configuration 0, but we're
* reaching into the corner of a corner case here, so let's
* not support buggy devices in these circumstances.
* stick to the specs: a configuration value of 0 means
* unconfigured. */
usbi_dbg("active cfg 0? assuming unconfigured device");
device_configured = 0;
}
}
}
dev_buf = malloc(DEVICE_DESC_LENGTH);
if (!dev_buf) {
close(fd);
return LIBUSB_ERROR_NO_MEM;
}
r = read(fd, dev_buf, DEVICE_DESC_LENGTH);
if (r < 0) {
usbi_err(DEVICE_CTX(dev),
"read descriptor failed ret=%d errno=%d", fd, errno);
free(dev_buf);
close(fd);
return LIBUSB_ERROR_IO;
} else if (r < DEVICE_DESC_LENGTH) {
usbi_err(DEVICE_CTX(dev), "short descriptor read (%d)", r);
free(dev_buf);
close(fd);
return LIBUSB_ERROR_IO;
}
/* bit of a hack: set num_configurations now because cache_active_config()
* calls usbi_get_config_index_by_value() which uses it */
dev->num_configurations = dev_buf[DEVICE_DESC_LENGTH - 1];
if (device_configured) {
r = cache_active_config(dev, fd, active_config);
if (r < 0) {
close(fd);
free(dev_buf);
return r;
}
}
close(fd);
priv->dev_descriptor = dev_buf;
return 0;
}
int linux_enumerate_device(struct libusb_context *ctx,
uint8_t busnum, uint8_t devaddr,
const char *sysfs_dir)
{
unsigned long session_id;
struct libusb_device *dev;
int r = 0;
/* FIXME: session ID is not guaranteed unique as addresses can wrap and
* will be reused. instead we should add a simple sysfs attribute with
* a session ID. */
session_id = busnum << 8 | devaddr;
usbi_dbg("busnum %d devaddr %d session_id %ld", busnum, devaddr,
session_id);
usbi_dbg("allocating new device for %d/%d (session %ld)",
busnum, devaddr, session_id);
dev = usbi_alloc_device(ctx, session_id);
if (!dev)
return LIBUSB_ERROR_NO_MEM;
r = initialize_device(dev, busnum, devaddr, sysfs_dir);
if (r < 0)
goto out;
r = usbi_sanitize_device(dev);
if (r < 0)
goto out;
out:
if (r < 0)
libusb_unref_device(dev);
else
usbi_connect_device(dev);
return r;
}
void linux_hotplug_enumerate(uint8_t busnum, uint8_t devaddr, const char *sys_name)
{
struct libusb_context *ctx;
list_for_each_entry(ctx, &active_contexts_list, list, struct libusb_context) {
if (usbi_get_device_by_session_id(ctx, busnum << 8 | devaddr)) {
/* device already exists in the context */
usbi_dbg("device already exists in context");
continue;
}
linux_enumerate_device(ctx, busnum, devaddr, sys_name);
}
}
void linux_hotplug_disconnected(uint8_t busnum, uint8_t devaddr, const char *sys_name)
{
struct libusb_context *ctx;
struct libusb_device *dev;
list_for_each_entry(ctx, &active_contexts_list, list, struct libusb_context) {
dev = usbi_get_device_by_session_id (ctx, busnum << 8 | devaddr);
if (NULL != dev) {
usbi_disconnect_device (dev);
} else {
usbi_err(ctx, "device not found for session %x %s", busnum << 8 | devaddr, sys_name);
}
}
}
#if !defined(USE_UDEV)
/* open a bus directory and adds all discovered devices to the context */
static int usbfs_scan_busdir(struct libusb_context *ctx, uint8_t busnum)
{
DIR *dir;
char dirpath[PATH_MAX];
struct dirent *entry;
int r = LIBUSB_ERROR_IO;
snprintf(dirpath, PATH_MAX, "%s/%03d", usbfs_path, busnum);
usbi_dbg("%s", dirpath);
dir = opendir(dirpath);
if (!dir) {
usbi_err(ctx, "opendir '%s' failed, errno=%d", dirpath, errno);
/* FIXME: should handle valid race conditions like hub unplugged
* during directory iteration - this is not an error */
return r;
}
while ((entry = readdir(dir))) {
int devaddr;
if (entry->d_name[0] == '.')
continue;
devaddr = atoi(entry->d_name);
if (devaddr == 0) {
usbi_dbg("unknown dir entry %s", entry->d_name);
continue;
}
if (linux_enumerate_device(ctx, busnum, (uint8_t) devaddr, NULL)) {
usbi_dbg("failed to enumerate dir entry %s", entry->d_name);
continue;
}
r = 0;
}
closedir(dir);
return r;
}
static int usbfs_get_device_list(struct libusb_context *ctx)
{
struct dirent *entry;
DIR *buses = opendir(usbfs_path);
int r = 0;
if (!buses) {
usbi_err(ctx, "opendir buses failed errno=%d", errno);
return LIBUSB_ERROR_IO;
}
while ((entry = readdir(buses))) {
int busnum;
if (entry->d_name[0] == '.')
continue;
if (usbdev_names) {
int devaddr;
if (!_is_usbdev_entry(entry, &busnum, &devaddr))
continue;
r = linux_enumerate_device(ctx, busnum, (uint8_t) devaddr, NULL);
if (r < 0) {
usbi_dbg("failed to enumerate dir entry %s", entry->d_name);
continue;
}
} else {
busnum = atoi(entry->d_name);
if (busnum == 0) {
usbi_dbg("unknown dir entry %s", entry->d_name);
continue;
}
r = usbfs_scan_busdir(ctx, busnum);
if (r < 0)
break;
}
}
closedir(buses);
return r;
}
static int sysfs_scan_device(struct libusb_context *ctx, const char *devname)
{
uint8_t busnum, devaddr;
int ret;
ret = linux_get_device_address (ctx, 0, &busnum, &devaddr, NULL, devname);
if (LIBUSB_SUCCESS != ret) {
return ret;
}
return linux_enumerate_device(ctx, busnum & 0xff, devaddr & 0xff,
devname);
}
static int sysfs_get_device_list(struct libusb_context *ctx)
{
DIR *devices = opendir(SYSFS_DEVICE_PATH);
struct dirent *entry;
int r = LIBUSB_ERROR_IO;
if (!devices) {
usbi_err(ctx, "opendir devices failed errno=%d", errno);
return r;
}
while ((entry = readdir(devices))) {
if ((!isdigit(entry->d_name[0]) && strncmp(entry->d_name, "usb", 3))
|| strchr(entry->d_name, ':'))
continue;
if (sysfs_scan_device(ctx, entry->d_name)) {
usbi_dbg("failed to enumerate dir entry %s", entry->d_name);
continue;
}
r = 0;
}
closedir(devices);
return r;
}
static int linux_default_scan_devices (struct libusb_context *ctx)
{
/* we can retrieve device list and descriptors from sysfs or usbfs.
* sysfs is preferable, because if we use usbfs we end up resuming
* any autosuspended USB devices. however, sysfs is not available
* everywhere, so we need a usbfs fallback too.
*
* as described in the "sysfs vs usbfs" comment at the top of this
* file, sometimes we have sysfs but not enough information to
* relate sysfs devices to usbfs nodes. op_init() determines the
* adequacy of sysfs and sets sysfs_can_relate_devices.
*/
if (sysfs_can_relate_devices != 0)
return sysfs_get_device_list(ctx);
else
return usbfs_get_device_list(ctx);
}
#endif
static int op_open(struct libusb_device_handle *handle)
{
struct linux_device_handle_priv *hpriv = _device_handle_priv(handle);
char filename[PATH_MAX];
int r;
_get_usbfs_path(handle->dev, filename);
usbi_dbg("opening %s", filename);
hpriv->fd = open(filename, O_RDWR);
if (hpriv->fd < 0) {
if (errno == EACCES) {
usbi_err(HANDLE_CTX(handle), "libusb couldn't open USB device %s: "
"Permission denied.", filename);
usbi_err(HANDLE_CTX(handle),
"libusb requires write access to USB device nodes.");
return LIBUSB_ERROR_ACCESS;
} else if (errno == ENOENT) {
usbi_err(HANDLE_CTX(handle), "libusb couldn't open USB device %s: "
"No such file or directory.", filename);
return LIBUSB_ERROR_NO_DEVICE;
} else {
usbi_err(HANDLE_CTX(handle),
"open failed, code %d errno %d", hpriv->fd, errno);
return LIBUSB_ERROR_IO;
}
}
r = ioctl(hpriv->fd, IOCTL_USBFS_GET_CAPABILITIES, &hpriv->caps);
if (r < 0) {
if (errno == ENOTTY)
usbi_dbg("%s: getcap not available", filename);
else
usbi_err(HANDLE_CTX(handle),
"%s: getcap failed (%d)", filename, errno);
hpriv->caps = 0;
if (supports_flag_zero_packet)
hpriv->caps |= USBFS_CAP_ZERO_PACKET;
if (supports_flag_bulk_continuation)
hpriv->caps |= USBFS_CAP_BULK_CONTINUATION;
}
return usbi_add_pollfd(HANDLE_CTX(handle), hpriv->fd, POLLOUT);
}
static void op_close(struct libusb_device_handle *dev_handle)
{
int fd = _device_handle_priv(dev_handle)->fd;
usbi_remove_pollfd(HANDLE_CTX(dev_handle), fd);
close(fd);
}
static int op_get_configuration(struct libusb_device_handle *handle,
int *config)
{
int r;
if (sysfs_can_relate_devices != 1)
return LIBUSB_ERROR_NOT_SUPPORTED;
r = sysfs_get_active_config(handle->dev, config);
if (r < 0)
return r;
if (*config == -1) {
usbi_err(HANDLE_CTX(handle), "device unconfigured");
*config = 0;
}
return 0;
}
static int op_set_configuration(struct libusb_device_handle *handle, int config)
{
struct linux_device_priv *priv = _device_priv(handle->dev);
int fd = _device_handle_priv(handle)->fd;
int r = ioctl(fd, IOCTL_USBFS_SETCONFIG, &config);
if (r) {
if (errno == EINVAL)
return LIBUSB_ERROR_NOT_FOUND;
else if (errno == EBUSY)
return LIBUSB_ERROR_BUSY;
else if (errno == ENODEV)
return LIBUSB_ERROR_NO_DEVICE;
usbi_err(HANDLE_CTX(handle), "failed, error %d errno %d", r, errno);
return LIBUSB_ERROR_OTHER;
}
if (!sysfs_has_descriptors) {
/* update our cached active config descriptor */
if (config == -1) {
if (priv->config_descriptor) {
free(priv->config_descriptor);
priv->config_descriptor = NULL;
}
} else {
r = cache_active_config(handle->dev, fd, config);
if (r < 0)
usbi_warn(HANDLE_CTX(handle),
"failed to update cached config descriptor, error %d", r);
}
}
return 0;
}
static int op_claim_interface(struct libusb_device_handle *handle, int iface)
{
int fd = _device_handle_priv(handle)->fd;
int r = ioctl(fd, IOCTL_USBFS_CLAIMINTF, &iface);
if (r) {
if (errno == ENOENT)
return LIBUSB_ERROR_NOT_FOUND;
else if (errno == EBUSY)
return LIBUSB_ERROR_BUSY;
else if (errno == ENODEV)
return LIBUSB_ERROR_NO_DEVICE;
usbi_err(HANDLE_CTX(handle),
"claim interface failed, error %d errno %d", r, errno);
return LIBUSB_ERROR_OTHER;
}
return 0;
}
static int op_release_interface(struct libusb_device_handle *handle, int iface)
{
int fd = _device_handle_priv(handle)->fd;
int r = ioctl(fd, IOCTL_USBFS_RELEASEINTF, &iface);
if (r) {
if (errno == ENODEV)
return LIBUSB_ERROR_NO_DEVICE;
usbi_err(HANDLE_CTX(handle),
"release interface failed, error %d errno %d", r, errno);
return LIBUSB_ERROR_OTHER;
}
return 0;
}
static int op_set_interface(struct libusb_device_handle *handle, int iface,
int altsetting)
{
int fd = _device_handle_priv(handle)->fd;
struct usbfs_setinterface setintf;
int r;
setintf.interface = iface;
setintf.altsetting = altsetting;
r = ioctl(fd, IOCTL_USBFS_SETINTF, &setintf);
if (r) {
if (errno == EINVAL)
return LIBUSB_ERROR_NOT_FOUND;
else if (errno == ENODEV)
return LIBUSB_ERROR_NO_DEVICE;
usbi_err(HANDLE_CTX(handle),
"setintf failed error %d errno %d", r, errno);
return LIBUSB_ERROR_OTHER;
}
return 0;
}
static int op_clear_halt(struct libusb_device_handle *handle,
unsigned char endpoint)
{
int fd = _device_handle_priv(handle)->fd;
unsigned int _endpoint = endpoint;
int r = ioctl(fd, IOCTL_USBFS_CLEAR_HALT, &_endpoint);
if (r) {
if (errno == ENOENT)
return LIBUSB_ERROR_NOT_FOUND;
else if (errno == ENODEV)
return LIBUSB_ERROR_NO_DEVICE;
usbi_err(HANDLE_CTX(handle),
"clear_halt failed error %d errno %d", r, errno);
return LIBUSB_ERROR_OTHER;
}
return 0;
}
static int op_reset_device(struct libusb_device_handle *handle)
{
int fd = _device_handle_priv(handle)->fd;
int i, r, ret = 0;
/* Doing a device reset will cause the usbfs driver to get unbound
from any interfaces it is bound to. By voluntarily unbinding
the usbfs driver ourself, we stop the kernel from rebinding
the interface after reset (which would end up with the interface
getting bound to the in kernel driver if any). */
for (i = 0; i < USB_MAXINTERFACES; i++) {
if (handle->claimed_interfaces & (1L << i)) {
op_release_interface(handle, i);
}
}
usbi_mutex_lock(&handle->lock);
r = ioctl(fd, IOCTL_USBFS_RESET, NULL);
if (r) {
if (errno == ENODEV) {
ret = LIBUSB_ERROR_NOT_FOUND;
goto out;
}
usbi_err(HANDLE_CTX(handle),
"reset failed error %d errno %d", r, errno);
ret = LIBUSB_ERROR_OTHER;
goto out;
}
/* And re-claim any interfaces which were claimed before the reset */
for (i = 0; i < USB_MAXINTERFACES; i++) {
if (handle->claimed_interfaces & (1L << i)) {
r = op_claim_interface(handle, i);
if (r) {
usbi_warn(HANDLE_CTX(handle),
"failed to re-claim interface %d after reset", i);
handle->claimed_interfaces &= ~(1L << i);
}
}
}
out:
usbi_mutex_unlock(&handle->lock);
return ret;
}
static int op_kernel_driver_active(struct libusb_device_handle *handle,
int interface)
{
int fd = _device_handle_priv(handle)->fd;
struct usbfs_getdriver getdrv;
int r;
getdrv.interface = interface;
r = ioctl(fd, IOCTL_USBFS_GETDRIVER, &getdrv);
if (r) {
if (errno == ENODATA)
return 0;
else if (errno == ENODEV)
return LIBUSB_ERROR_NO_DEVICE;
usbi_err(HANDLE_CTX(handle),
"get driver failed error %d errno %d", r, errno);
return LIBUSB_ERROR_OTHER;
}
return 1;
}
static int op_detach_kernel_driver(struct libusb_device_handle *handle,
int interface)
{
int fd = _device_handle_priv(handle)->fd;
struct usbfs_ioctl command;
int r;
command.ifno = interface;
command.ioctl_code = IOCTL_USBFS_DISCONNECT;
command.data = NULL;
r = ioctl(fd, IOCTL_USBFS_IOCTL, &command);
if (r) {
if (errno == ENODATA)
return LIBUSB_ERROR_NOT_FOUND;
else if (errno == EINVAL)
return LIBUSB_ERROR_INVALID_PARAM;
else if (errno == ENODEV)
return LIBUSB_ERROR_NO_DEVICE;
usbi_err(HANDLE_CTX(handle),
"detach failed error %d errno %d", r, errno);
return LIBUSB_ERROR_OTHER;
}
return 0;
}
static int op_attach_kernel_driver(struct libusb_device_handle *handle,
int interface)
{
int fd = _device_handle_priv(handle)->fd;
struct usbfs_ioctl command;
int r;
command.ifno = interface;
command.ioctl_code = IOCTL_USBFS_CONNECT;
command.data = NULL;
r = ioctl(fd, IOCTL_USBFS_IOCTL, &command);
if (r < 0) {
if (errno == ENODATA)
return LIBUSB_ERROR_NOT_FOUND;
else if (errno == EINVAL)
return LIBUSB_ERROR_INVALID_PARAM;
else if (errno == ENODEV)
return LIBUSB_ERROR_NO_DEVICE;
else if (errno == EBUSY)
return LIBUSB_ERROR_BUSY;
usbi_err(HANDLE_CTX(handle),
"attach failed error %d errno %d", r, errno);
return LIBUSB_ERROR_OTHER;
} else if (r == 0) {
return LIBUSB_ERROR_NOT_FOUND;
}
return 0;
}
static void op_destroy_device(struct libusb_device *dev)
{
struct linux_device_priv *priv = _device_priv(dev);
if (!sysfs_has_descriptors) {
if (priv->dev_descriptor)
free(priv->dev_descriptor);
if (priv->config_descriptor)
free(priv->config_descriptor);
}
if (priv->sysfs_dir)
free(priv->sysfs_dir);
}
/* URBs are discarded in reverse order of submission to avoid races. */
static int discard_urbs(struct usbi_transfer *itransfer, int first, int last_plus_one)
{
struct libusb_transfer *transfer =
USBI_TRANSFER_TO_LIBUSB_TRANSFER(itransfer);
struct linux_transfer_priv *tpriv =
usbi_transfer_get_os_priv(itransfer);
struct linux_device_handle_priv *dpriv =
_device_handle_priv(transfer->dev_handle);
int i, ret = 0;
struct usbfs_urb *urb;
for (i = last_plus_one - 1; i >= first; i--) {
if (LIBUSB_TRANSFER_TYPE_ISOCHRONOUS == transfer->type)
urb = tpriv->iso_urbs[i];
else
urb = &tpriv->urbs[i];
if (0 == ioctl(dpriv->fd, IOCTL_USBFS_DISCARDURB, urb))
continue;
if (EINVAL == errno) {
usbi_dbg("URB not found --> assuming ready to be reaped");
if (i == (last_plus_one - 1))
ret = LIBUSB_ERROR_NOT_FOUND;
} else if (ENODEV == errno) {
usbi_dbg("Device not found for URB --> assuming ready to be reaped");
ret = LIBUSB_ERROR_NO_DEVICE;
} else {
usbi_warn(TRANSFER_CTX(transfer),
"unrecognised discard errno %d", errno);
ret = LIBUSB_ERROR_OTHER;
}
}
return ret;
}
static void free_iso_urbs(struct linux_transfer_priv *tpriv)
{
int i;
for (i = 0; i < tpriv->num_urbs; i++) {
struct usbfs_urb *urb = tpriv->iso_urbs[i];
if (!urb)
break;
free(urb);
}
free(tpriv->iso_urbs);
tpriv->iso_urbs = NULL;
}
static int submit_bulk_transfer(struct usbi_transfer *itransfer,
unsigned char urb_type)
{
struct libusb_transfer *transfer =
USBI_TRANSFER_TO_LIBUSB_TRANSFER(itransfer);
struct linux_transfer_priv *tpriv = usbi_transfer_get_os_priv(itransfer);
struct linux_device_handle_priv *dpriv =
_device_handle_priv(transfer->dev_handle);
struct usbfs_urb *urbs;
int is_out = (transfer->endpoint & LIBUSB_ENDPOINT_DIR_MASK)
== LIBUSB_ENDPOINT_OUT;
int bulk_buffer_len, use_bulk_continuation;
int r;
int i;
size_t alloc_size;
if (tpriv->urbs)
return LIBUSB_ERROR_BUSY;
if (is_out && (transfer->flags & LIBUSB_TRANSFER_ADD_ZERO_PACKET) &&
!(dpriv->caps & USBFS_CAP_ZERO_PACKET))
return LIBUSB_ERROR_NOT_SUPPORTED;
/*
* Older versions of usbfs place a 16kb limit on bulk URBs. We work
* around this by splitting large transfers into 16k blocks, and then
* submit all urbs at once. it would be simpler to submit one urb at
* a time, but there is a big performance gain doing it this way.
*
* Newer versions lift the 16k limit (USBFS_CAP_NO_PACKET_SIZE_LIM),
* using arbritary large transfers can still be a bad idea though, as
* the kernel needs to allocate physical contiguous memory for this,
* which may fail for large buffers.
*
* The kernel solves this problem by splitting the transfer into
* blocks itself when the host-controller is scatter-gather capable
* (USBFS_CAP_BULK_SCATTER_GATHER), which most controllers are.
*
* Last, there is the issue of short-transfers when splitting, for
* short split-transfers to work reliable USBFS_CAP_BULK_CONTINUATION
* is needed, but this is not always available.
*/
if (dpriv->caps & USBFS_CAP_BULK_SCATTER_GATHER) {
/* Good! Just submit everything in one go */
bulk_buffer_len = transfer->length ? transfer->length : 1;
use_bulk_continuation = 0;
} else if (dpriv->caps & USBFS_CAP_BULK_CONTINUATION) {
/* Split the transfers and use bulk-continuation to
avoid issues with short-transfers */
bulk_buffer_len = MAX_BULK_BUFFER_LENGTH;
use_bulk_continuation = 1;
} else if (dpriv->caps & USBFS_CAP_NO_PACKET_SIZE_LIM) {
/* Don't split, assume the kernel can alloc the buffer
(otherwise the submit will fail with -ENOMEM) */
bulk_buffer_len = transfer->length ? transfer->length : 1;
use_bulk_continuation = 0;
} else {
/* Bad, splitting without bulk-continuation, short transfers
which end before the last urb will not work reliable! */
/* Note we don't warn here as this is "normal" on kernels <
2.6.32 and not a problem for most applications */
bulk_buffer_len = MAX_BULK_BUFFER_LENGTH;
use_bulk_continuation = 0;
}
int num_urbs = transfer->length / bulk_buffer_len;
int last_urb_partial = 0;
if (transfer->length == 0) {
num_urbs = 1;
} else if ((transfer->length % bulk_buffer_len) > 0) {
last_urb_partial = 1;
num_urbs++;
}
usbi_dbg("need %d urbs for new transfer with length %d", num_urbs,
transfer->length);
alloc_size = num_urbs * sizeof(struct usbfs_urb);
urbs = malloc(alloc_size);
if (!urbs)
return LIBUSB_ERROR_NO_MEM;
memset(urbs, 0, alloc_size);
tpriv->urbs = urbs;
tpriv->num_urbs = num_urbs;
tpriv->num_retired = 0;
tpriv->reap_action = NORMAL;
tpriv->reap_status = LIBUSB_TRANSFER_COMPLETED;
for (i = 0; i < num_urbs; i++) {
struct usbfs_urb *urb = &urbs[i];
urb->usercontext = itransfer;
urb->type = urb_type;
urb->endpoint = transfer->endpoint;
urb->buffer = transfer->buffer + (i * bulk_buffer_len);
/* don't set the short not ok flag for the last URB */
if (use_bulk_continuation && !is_out && i < num_urbs - 1)
urb->flags = USBFS_URB_SHORT_NOT_OK;
if (i == num_urbs - 1 && last_urb_partial)
urb->buffer_length = transfer->length % bulk_buffer_len;
else if (transfer->length == 0)
urb->buffer_length = 0;
else
urb->buffer_length = bulk_buffer_len;
if (i > 0 && use_bulk_continuation)
urb->flags |= USBFS_URB_BULK_CONTINUATION;
/* we have already checked that the flag is supported */
if (is_out && i == num_urbs - 1 &&
transfer->flags & LIBUSB_TRANSFER_ADD_ZERO_PACKET)
urb->flags |= USBFS_URB_ZERO_PACKET;
r = ioctl(dpriv->fd, IOCTL_USBFS_SUBMITURB, urb);
if (r < 0) {
if (errno == ENODEV) {
r = LIBUSB_ERROR_NO_DEVICE;
} else {
usbi_err(TRANSFER_CTX(transfer),
"submiturb failed error %d errno=%d", r, errno);
r = LIBUSB_ERROR_IO;
}
/* if the first URB submission fails, we can simply free up and
* return failure immediately. */
if (i == 0) {
usbi_dbg("first URB failed, easy peasy");
free(urbs);
tpriv->urbs = NULL;
return r;
}
/* if it's not the first URB that failed, the situation is a bit
* tricky. we may need to discard all previous URBs. there are
* complications:
* - discarding is asynchronous - discarded urbs will be reaped
* later. the user must not have freed the transfer when the
* discarded URBs are reaped, otherwise libusb will be using
* freed memory.
* - the earlier URBs may have completed successfully and we do
* not want to throw away any data.
* - this URB failing may be no error; EREMOTEIO means that
* this transfer simply didn't need all the URBs we submitted
* so, we report that the transfer was submitted successfully and
* in case of error we discard all previous URBs. later when
* the final reap completes we can report error to the user,
* or success if an earlier URB was completed successfully.
*/
tpriv->reap_action = EREMOTEIO == errno ? COMPLETED_EARLY : SUBMIT_FAILED;
/* The URBs we haven't submitted yet we count as already
* retired. */
tpriv->num_retired += num_urbs - i;
/* If we completed short then don't try to discard. */
if (COMPLETED_EARLY == tpriv->reap_action)
return 0;
discard_urbs(itransfer, 0, i);
usbi_dbg("reporting successful submission but waiting for %d "
"discards before reporting error", i);
return 0;
}
}
return 0;
}
static int submit_iso_transfer(struct usbi_transfer *itransfer)
{
struct libusb_transfer *transfer =
USBI_TRANSFER_TO_LIBUSB_TRANSFER(itransfer);
struct linux_transfer_priv *tpriv = usbi_transfer_get_os_priv(itransfer);
struct linux_device_handle_priv *dpriv =
_device_handle_priv(transfer->dev_handle);
struct usbfs_urb **urbs;
size_t alloc_size;
int num_packets = transfer->num_iso_packets;
int i;
int this_urb_len = 0;
int num_urbs = 1;
int packet_offset = 0;
unsigned int packet_len;
unsigned char *urb_buffer = transfer->buffer;
if (tpriv->iso_urbs)
return LIBUSB_ERROR_BUSY;
/* usbfs places a 32kb limit on iso URBs. we divide up larger requests
* into smaller units to meet such restriction, then fire off all the
* units at once. it would be simpler if we just fired one unit at a time,
* but there is a big performance gain through doing it this way.
*
* Newer kernels lift the 32k limit (USBFS_CAP_NO_PACKET_SIZE_LIM),
* using arbritary large transfers is still be a bad idea though, as
* the kernel needs to allocate physical contiguous memory for this,
* which may fail for large buffers.
*/
/* calculate how many URBs we need */
for (i = 0; i < num_packets; i++) {
unsigned int space_remaining = MAX_ISO_BUFFER_LENGTH - this_urb_len;
packet_len = transfer->iso_packet_desc[i].length;
if (packet_len > space_remaining) {
num_urbs++;
this_urb_len = packet_len;
} else {
this_urb_len += packet_len;
}
}
usbi_dbg("need %d 32k URBs for transfer", num_urbs);
alloc_size = num_urbs * sizeof(*urbs);
urbs = malloc(alloc_size);
if (!urbs)
return LIBUSB_ERROR_NO_MEM;
memset(urbs, 0, alloc_size);
tpriv->iso_urbs = urbs;
tpriv->num_urbs = num_urbs;
tpriv->num_retired = 0;
tpriv->reap_action = NORMAL;
tpriv->iso_packet_offset = 0;
/* allocate + initialize each URB with the correct number of packets */
for (i = 0; i < num_urbs; i++) {
struct usbfs_urb *urb;
unsigned int space_remaining_in_urb = MAX_ISO_BUFFER_LENGTH;
int urb_packet_offset = 0;
unsigned char *urb_buffer_orig = urb_buffer;
int j;
int k;
/* swallow up all the packets we can fit into this URB */
while (packet_offset < transfer->num_iso_packets) {
packet_len = transfer->iso_packet_desc[packet_offset].length;
if (packet_len <= space_remaining_in_urb) {
/* throw it in */
urb_packet_offset++;
packet_offset++;
space_remaining_in_urb -= packet_len;
urb_buffer += packet_len;
} else {
/* it can't fit, save it for the next URB */
break;
}
}
alloc_size = sizeof(*urb)
+ (urb_packet_offset * sizeof(struct usbfs_iso_packet_desc));
urb = malloc(alloc_size);
if (!urb) {
free_iso_urbs(tpriv);
return LIBUSB_ERROR_NO_MEM;
}
memset(urb, 0, alloc_size);
urbs[i] = urb;
/* populate packet lengths */
for (j = 0, k = packet_offset - urb_packet_offset;
k < packet_offset; k++, j++) {
packet_len = transfer->iso_packet_desc[k].length;
urb->iso_frame_desc[j].length = packet_len;
}
urb->usercontext = itransfer;
urb->type = USBFS_URB_TYPE_ISO;
/* FIXME: interface for non-ASAP data? */
urb->flags = USBFS_URB_ISO_ASAP;
urb->endpoint = transfer->endpoint;
urb->number_of_packets = urb_packet_offset;
urb->buffer = urb_buffer_orig;
}
/* submit URBs */
for (i = 0; i < num_urbs; i++) {
int r = ioctl(dpriv->fd, IOCTL_USBFS_SUBMITURB, urbs[i]);
if (r < 0) {
if (errno == ENODEV) {
r = LIBUSB_ERROR_NO_DEVICE;
} else {
usbi_err(TRANSFER_CTX(transfer),
"submiturb failed error %d errno=%d", r, errno);
r = LIBUSB_ERROR_IO;
}
/* if the first URB submission fails, we can simply free up and
* return failure immediately. */
if (i == 0) {
usbi_dbg("first URB failed, easy peasy");
free_iso_urbs(tpriv);
return r;
}
/* if it's not the first URB that failed, the situation is a bit
* tricky. we must discard all previous URBs. there are
* complications:
* - discarding is asynchronous - discarded urbs will be reaped
* later. the user must not have freed the transfer when the
* discarded URBs are reaped, otherwise libusb will be using
* freed memory.
* - the earlier URBs may have completed successfully and we do
* not want to throw away any data.
* so, in this case we discard all the previous URBs BUT we report
* that the transfer was submitted successfully. then later when
* the final discard completes we can report error to the user.
*/
tpriv->reap_action = SUBMIT_FAILED;
/* The URBs we haven't submitted yet we count as already
* retired. */
tpriv->num_retired = num_urbs - i;
discard_urbs(itransfer, 0, i);
usbi_dbg("reporting successful submission but waiting for %d "
"discards before reporting error", i);
return 0;
}
}
return 0;
}
static int submit_control_transfer(struct usbi_transfer *itransfer)
{
struct linux_transfer_priv *tpriv = usbi_transfer_get_os_priv(itransfer);
struct libusb_transfer *transfer =
USBI_TRANSFER_TO_LIBUSB_TRANSFER(itransfer);
struct linux_device_handle_priv *dpriv =
_device_handle_priv(transfer->dev_handle);
struct usbfs_urb *urb;
int r;
if (tpriv->urbs)
return LIBUSB_ERROR_BUSY;
if (transfer->length - LIBUSB_CONTROL_SETUP_SIZE > MAX_CTRL_BUFFER_LENGTH)
return LIBUSB_ERROR_INVALID_PARAM;
urb = malloc(sizeof(struct usbfs_urb));
if (!urb)
return LIBUSB_ERROR_NO_MEM;
memset(urb, 0, sizeof(struct usbfs_urb));
tpriv->urbs = urb;
tpriv->num_urbs = 1;
tpriv->reap_action = NORMAL;
urb->usercontext = itransfer;
urb->type = USBFS_URB_TYPE_CONTROL;
urb->endpoint = transfer->endpoint;
urb->buffer = transfer->buffer;
urb->buffer_length = transfer->length;
r = ioctl(dpriv->fd, IOCTL_USBFS_SUBMITURB, urb);
if (r < 0) {
free(urb);
tpriv->urbs = NULL;
if (errno == ENODEV)
return LIBUSB_ERROR_NO_DEVICE;
usbi_err(TRANSFER_CTX(transfer),
"submiturb failed error %d errno=%d", r, errno);
return LIBUSB_ERROR_IO;
}
return 0;
}
static int op_submit_transfer(struct usbi_transfer *itransfer)
{
struct libusb_transfer *transfer =
USBI_TRANSFER_TO_LIBUSB_TRANSFER(itransfer);
switch (transfer->type) {
case LIBUSB_TRANSFER_TYPE_CONTROL:
return submit_control_transfer(itransfer);
case LIBUSB_TRANSFER_TYPE_BULK:
return submit_bulk_transfer(itransfer, USBFS_URB_TYPE_BULK);
case LIBUSB_TRANSFER_TYPE_INTERRUPT:
return submit_bulk_transfer(itransfer, USBFS_URB_TYPE_INTERRUPT);
case LIBUSB_TRANSFER_TYPE_ISOCHRONOUS:
return submit_iso_transfer(itransfer);
default:
usbi_err(TRANSFER_CTX(transfer),
"unknown endpoint type %d", transfer->type);
return LIBUSB_ERROR_INVALID_PARAM;
}
}
static int op_cancel_transfer(struct usbi_transfer *itransfer)
{
struct linux_transfer_priv *tpriv = usbi_transfer_get_os_priv(itransfer);
struct libusb_transfer *transfer =
USBI_TRANSFER_TO_LIBUSB_TRANSFER(itransfer);
switch (transfer->type) {
case LIBUSB_TRANSFER_TYPE_BULK:
if (tpriv->reap_action == ERROR)
break;
/* else, fall through */
case LIBUSB_TRANSFER_TYPE_CONTROL:
case LIBUSB_TRANSFER_TYPE_INTERRUPT:
case LIBUSB_TRANSFER_TYPE_ISOCHRONOUS:
tpriv->reap_action = CANCELLED;
break;
default:
usbi_err(TRANSFER_CTX(transfer),
"unknown endpoint type %d", transfer->type);
return LIBUSB_ERROR_INVALID_PARAM;
}
if (!tpriv->urbs)
return LIBUSB_ERROR_NOT_FOUND;
return discard_urbs(itransfer, 0, tpriv->num_urbs);
}
static void op_clear_transfer_priv(struct usbi_transfer *itransfer)
{
struct libusb_transfer *transfer =
USBI_TRANSFER_TO_LIBUSB_TRANSFER(itransfer);
struct linux_transfer_priv *tpriv = usbi_transfer_get_os_priv(itransfer);
/* urbs can be freed also in submit_transfer so lock mutex first */
switch (transfer->type) {
case LIBUSB_TRANSFER_TYPE_CONTROL:
case LIBUSB_TRANSFER_TYPE_BULK:
case LIBUSB_TRANSFER_TYPE_INTERRUPT:
usbi_mutex_lock(&itransfer->lock);
if (tpriv->urbs)
free(tpriv->urbs);
tpriv->urbs = NULL;
usbi_mutex_unlock(&itransfer->lock);
break;
case LIBUSB_TRANSFER_TYPE_ISOCHRONOUS:
usbi_mutex_lock(&itransfer->lock);
if (tpriv->iso_urbs)
free_iso_urbs(tpriv);
usbi_mutex_unlock(&itransfer->lock);
break;
default:
usbi_err(TRANSFER_CTX(transfer),
"unknown endpoint type %d", transfer->type);
}
}
static int handle_bulk_completion(struct usbi_transfer *itransfer,
struct usbfs_urb *urb)
{
struct linux_transfer_priv *tpriv = usbi_transfer_get_os_priv(itransfer);
struct libusb_transfer *transfer = USBI_TRANSFER_TO_LIBUSB_TRANSFER(itransfer);
int urb_idx = urb - tpriv->urbs;
usbi_mutex_lock(&itransfer->lock);
usbi_dbg("handling completion status %d of bulk urb %d/%d", urb->status,
urb_idx + 1, tpriv->num_urbs);
tpriv->num_retired++;
if (tpriv->reap_action != NORMAL) {
/* cancelled, submit_fail, or completed early */
usbi_dbg("abnormal reap: urb status %d", urb->status);
/* even though we're in the process of cancelling, it's possible that
* we may receive some data in these URBs that we don't want to lose.
* examples:
* 1. while the kernel is cancelling all the packets that make up an
* URB, a few of them might complete. so we get back a successful
* cancellation *and* some data.
* 2. we receive a short URB which marks the early completion condition,
* so we start cancelling the remaining URBs. however, we're too
* slow and another URB completes (or at least completes partially).
* (this can't happen since we always use BULK_CONTINUATION.)
*
* When this happens, our objectives are not to lose any "surplus" data,
* and also to stick it at the end of the previously-received data
* (closing any holes), so that libusb reports the total amount of
* transferred data and presents it in a contiguous chunk.
*/
if (urb->actual_length > 0) {
unsigned char *target = transfer->buffer + itransfer->transferred;
usbi_dbg("received %d bytes of surplus data", urb->actual_length);
if (urb->buffer != target) {
usbi_dbg("moving surplus data from offset %d to offset %d",
(unsigned char *) urb->buffer - transfer->buffer,
target - transfer->buffer);
memmove(target, urb->buffer, urb->actual_length);
}
itransfer->transferred += urb->actual_length;
}
if (tpriv->num_retired == tpriv->num_urbs) {
usbi_dbg("abnormal reap: last URB handled, reporting");
if (tpriv->reap_action != COMPLETED_EARLY &&
tpriv->reap_status == LIBUSB_TRANSFER_COMPLETED)
tpriv->reap_status = LIBUSB_TRANSFER_ERROR;
goto completed;
}
goto out_unlock;
}
itransfer->transferred += urb->actual_length;
/* Many of these errors can occur on *any* urb of a multi-urb
* transfer. When they do, we tear down the rest of the transfer.
*/
switch (urb->status) {
case 0:
break;
case -EREMOTEIO: /* short transfer */
break;
case -ENOENT: /* cancelled */
case -ECONNRESET:
break;
case -ENODEV:
case -ESHUTDOWN:
usbi_dbg("device removed");
tpriv->reap_status = LIBUSB_TRANSFER_NO_DEVICE;
goto cancel_remaining;
case -EPIPE:
usbi_dbg("detected endpoint stall");
if (tpriv->reap_status == LIBUSB_TRANSFER_COMPLETED)
tpriv->reap_status = LIBUSB_TRANSFER_STALL;
goto cancel_remaining;
case -EOVERFLOW:
/* overflow can only ever occur in the last urb */
usbi_dbg("overflow, actual_length=%d", urb->actual_length);
if (tpriv->reap_status == LIBUSB_TRANSFER_COMPLETED)
tpriv->reap_status = LIBUSB_TRANSFER_OVERFLOW;
goto completed;
case -ETIME:
case -EPROTO:
case -EILSEQ:
case -ECOMM:
case -ENOSR:
usbi_dbg("low level error %d", urb->status);
tpriv->reap_action = ERROR;
goto cancel_remaining;
default:
usbi_warn(ITRANSFER_CTX(itransfer),
"unrecognised urb status %d", urb->status);
tpriv->reap_action = ERROR;
goto cancel_remaining;
}
/* if we're the last urb or we got less data than requested then we're
* done */
if (urb_idx == tpriv->num_urbs - 1) {
usbi_dbg("last URB in transfer --> complete!");
goto completed;
} else if (urb->actual_length < urb->buffer_length) {
usbi_dbg("short transfer %d/%d --> complete!",
urb->actual_length, urb->buffer_length);
if (tpriv->reap_action == NORMAL)
tpriv->reap_action = COMPLETED_EARLY;
} else
goto out_unlock;
cancel_remaining:
if (ERROR == tpriv->reap_action && LIBUSB_TRANSFER_COMPLETED == tpriv->reap_status)
tpriv->reap_status = LIBUSB_TRANSFER_ERROR;
if (tpriv->num_retired == tpriv->num_urbs) /* nothing to cancel */
goto completed;
/* cancel remaining urbs and wait for their completion before
* reporting results */
discard_urbs(itransfer, urb_idx + 1, tpriv->num_urbs);
out_unlock:
usbi_mutex_unlock(&itransfer->lock);
return 0;
completed:
free(tpriv->urbs);
tpriv->urbs = NULL;
usbi_mutex_unlock(&itransfer->lock);
return CANCELLED == tpriv->reap_action ?
usbi_handle_transfer_cancellation(itransfer) :
usbi_handle_transfer_completion(itransfer, tpriv->reap_status);
}
static int handle_iso_completion(struct usbi_transfer *itransfer,
struct usbfs_urb *urb)
{
struct libusb_transfer *transfer =
USBI_TRANSFER_TO_LIBUSB_TRANSFER(itransfer);
struct linux_transfer_priv *tpriv = usbi_transfer_get_os_priv(itransfer);
int num_urbs = tpriv->num_urbs;
int urb_idx = 0;
int i;
enum libusb_transfer_status status = LIBUSB_TRANSFER_COMPLETED;
usbi_mutex_lock(&itransfer->lock);
for (i = 0; i < num_urbs; i++) {
if (urb == tpriv->iso_urbs[i]) {
urb_idx = i + 1;
break;
}
}
if (urb_idx == 0) {
usbi_err(TRANSFER_CTX(transfer), "could not locate urb!");
usbi_mutex_unlock(&itransfer->lock);
return LIBUSB_ERROR_NOT_FOUND;
}
usbi_dbg("handling completion status %d of iso urb %d/%d", urb->status,
urb_idx, num_urbs);
/* copy isochronous results back in */
for (i = 0; i < urb->number_of_packets; i++) {
struct usbfs_iso_packet_desc *urb_desc = &urb->iso_frame_desc[i];
struct libusb_iso_packet_descriptor *lib_desc =
&transfer->iso_packet_desc[tpriv->iso_packet_offset++];
lib_desc->status = LIBUSB_TRANSFER_COMPLETED;
switch (urb_desc->status) {
case 0:
break;
case -ENOENT: /* cancelled */
case -ECONNRESET:
break;
case -ENODEV:
case -ESHUTDOWN:
usbi_dbg("device removed");
lib_desc->status = LIBUSB_TRANSFER_NO_DEVICE;
break;
case -EPIPE:
usbi_dbg("detected endpoint stall");
lib_desc->status = LIBUSB_TRANSFER_STALL;
break;
case -EOVERFLOW:
usbi_dbg("overflow error");
lib_desc->status = LIBUSB_TRANSFER_OVERFLOW;
break;
case -ETIME:
case -EPROTO:
case -EILSEQ:
case -ECOMM:
case -ENOSR:
case -EXDEV:
usbi_dbg("low-level USB error %d", urb_desc->status);
lib_desc->status = LIBUSB_TRANSFER_ERROR;
break;
default:
usbi_warn(TRANSFER_CTX(transfer),
"unrecognised urb status %d", urb_desc->status);
lib_desc->status = LIBUSB_TRANSFER_ERROR;
break;
}
lib_desc->actual_length = urb_desc->actual_length;
}
tpriv->num_retired++;
if (tpriv->reap_action != NORMAL) { /* cancelled or submit_fail */
usbi_dbg("CANCEL: urb status %d", urb->status);
if (tpriv->num_retired == num_urbs) {
usbi_dbg("CANCEL: last URB handled, reporting");
free_iso_urbs(tpriv);
if (tpriv->reap_action == CANCELLED) {
usbi_mutex_unlock(&itransfer->lock);
return usbi_handle_transfer_cancellation(itransfer);
} else {
usbi_mutex_unlock(&itransfer->lock);
return usbi_handle_transfer_completion(itransfer,
LIBUSB_TRANSFER_ERROR);
}
}
goto out;
}
switch (urb->status) {
case 0:
break;
case -ENOENT: /* cancelled */
case -ECONNRESET:
break;
case -ESHUTDOWN:
usbi_dbg("device removed");
status = LIBUSB_TRANSFER_NO_DEVICE;
break;
default:
usbi_warn(TRANSFER_CTX(transfer),
"unrecognised urb status %d", urb->status);
status = LIBUSB_TRANSFER_ERROR;
break;
}
/* if we're the last urb then we're done */
if (urb_idx == num_urbs) {
usbi_dbg("last URB in transfer --> complete!");
free_iso_urbs(tpriv);
usbi_mutex_unlock(&itransfer->lock);
return usbi_handle_transfer_completion(itransfer, status);
}
out:
usbi_mutex_unlock(&itransfer->lock);
return 0;
}
static int handle_control_completion(struct usbi_transfer *itransfer,
struct usbfs_urb *urb)
{
struct linux_transfer_priv *tpriv = usbi_transfer_get_os_priv(itransfer);
int status;
usbi_mutex_lock(&itransfer->lock);
usbi_dbg("handling completion status %d", urb->status);
itransfer->transferred += urb->actual_length;
if (tpriv->reap_action == CANCELLED) {
if (urb->status != 0 && urb->status != -ENOENT)
usbi_warn(ITRANSFER_CTX(itransfer),
"cancel: unrecognised urb status %d", urb->status);
free(tpriv->urbs);
tpriv->urbs = NULL;
usbi_mutex_unlock(&itransfer->lock);
return usbi_handle_transfer_cancellation(itransfer);
}
switch (urb->status) {
case 0:
status = LIBUSB_TRANSFER_COMPLETED;
break;
case -ENOENT: /* cancelled */
status = LIBUSB_TRANSFER_CANCELLED;
break;
case -ENODEV:
case -ESHUTDOWN:
usbi_dbg("device removed");
status = LIBUSB_TRANSFER_NO_DEVICE;
break;
case -EPIPE:
usbi_dbg("unsupported control request");
status = LIBUSB_TRANSFER_STALL;
break;
case -EOVERFLOW:
usbi_dbg("control overflow error");
status = LIBUSB_TRANSFER_OVERFLOW;
break;
case -ETIME:
case -EPROTO:
case -EILSEQ:
case -ECOMM:
case -ENOSR:
usbi_dbg("low-level bus error occurred");
status = LIBUSB_TRANSFER_ERROR;
break;
default:
usbi_warn(ITRANSFER_CTX(itransfer),
"unrecognised urb status %d", urb->status);
status = LIBUSB_TRANSFER_ERROR;
break;
}
free(tpriv->urbs);
tpriv->urbs = NULL;
usbi_mutex_unlock(&itransfer->lock);
return usbi_handle_transfer_completion(itransfer, status);
}
static int reap_for_handle(struct libusb_device_handle *handle)
{
struct linux_device_handle_priv *hpriv = _device_handle_priv(handle);
int r;
struct usbfs_urb *urb;
struct usbi_transfer *itransfer;
struct libusb_transfer *transfer;
r = ioctl(hpriv->fd, IOCTL_USBFS_REAPURBNDELAY, &urb);
if (r == -1 && errno == EAGAIN)
return 1;
if (r < 0) {
if (errno == ENODEV)
return LIBUSB_ERROR_NO_DEVICE;
usbi_err(HANDLE_CTX(handle), "reap failed error %d errno=%d",
r, errno);
return LIBUSB_ERROR_IO;
}
itransfer = urb->usercontext;
transfer = USBI_TRANSFER_TO_LIBUSB_TRANSFER(itransfer);
usbi_dbg("urb type=%d status=%d transferred=%d", urb->type, urb->status,
urb->actual_length);
switch (transfer->type) {
case LIBUSB_TRANSFER_TYPE_ISOCHRONOUS:
return handle_iso_completion(itransfer, urb);
case LIBUSB_TRANSFER_TYPE_BULK:
case LIBUSB_TRANSFER_TYPE_INTERRUPT:
return handle_bulk_completion(itransfer, urb);
case LIBUSB_TRANSFER_TYPE_CONTROL:
return handle_control_completion(itransfer, urb);
default:
usbi_err(HANDLE_CTX(handle), "unrecognised endpoint type %x",
transfer->type);
return LIBUSB_ERROR_OTHER;
}
}
static int op_handle_events(struct libusb_context *ctx,
struct pollfd *fds, POLL_NFDS_TYPE nfds, int num_ready)
{
int r;
unsigned int i = 0;
usbi_mutex_lock(&ctx->open_devs_lock);
for (i = 0; i < nfds && num_ready > 0; i++) {
struct pollfd *pollfd = &fds[i];
struct libusb_device_handle *handle;
struct linux_device_handle_priv *hpriv = NULL;
if (!pollfd->revents)
continue;
num_ready--;
list_for_each_entry(handle, &ctx->open_devs, list, struct libusb_device_handle) {
hpriv = _device_handle_priv(handle);
if (hpriv->fd == pollfd->fd)
break;
}
if (pollfd->revents & POLLERR) {
usbi_remove_pollfd(HANDLE_CTX(handle), hpriv->fd);
usbi_handle_disconnect(handle);
continue;
}
do {
r = reap_for_handle(handle);
} while (r == 0);
if (r == 1 || r == LIBUSB_ERROR_NO_DEVICE)
continue;
else if (r < 0)
goto out;
}
r = 0;
out:
usbi_mutex_unlock(&ctx->open_devs_lock);
return r;
}
static int op_clock_gettime(int clk_id, struct timespec *tp)
{
switch (clk_id) {
case USBI_CLOCK_MONOTONIC:
return clock_gettime(monotonic_clkid, tp);
case USBI_CLOCK_REALTIME:
return clock_gettime(CLOCK_REALTIME, tp);
default:
return LIBUSB_ERROR_INVALID_PARAM;
}
}
#ifdef USBI_TIMERFD_AVAILABLE
static clockid_t op_get_timerfd_clockid(void)
{
return monotonic_clkid;
}
#endif
const struct usbi_os_backend linux_usbfs_backend = {
.name = "Linux usbfs",
.init = op_init,
.exit = op_exit,
.get_device_list = NULL,
.get_device_descriptor = op_get_device_descriptor,
.get_active_config_descriptor = op_get_active_config_descriptor,
.get_config_descriptor = op_get_config_descriptor,
.open = op_open,
.close = op_close,
.get_configuration = op_get_configuration,
.set_configuration = op_set_configuration,
.claim_interface = op_claim_interface,
.release_interface = op_release_interface,
.set_interface_altsetting = op_set_interface,
.clear_halt = op_clear_halt,
.reset_device = op_reset_device,
.kernel_driver_active = op_kernel_driver_active,
.detach_kernel_driver = op_detach_kernel_driver,
.attach_kernel_driver = op_attach_kernel_driver,
.destroy_device = op_destroy_device,
.submit_transfer = op_submit_transfer,
.cancel_transfer = op_cancel_transfer,
.clear_transfer_priv = op_clear_transfer_priv,
.handle_events = op_handle_events,
.clock_gettime = op_clock_gettime,
#ifdef USBI_TIMERFD_AVAILABLE
.get_timerfd_clockid = op_get_timerfd_clockid,
#endif
.device_priv_size = sizeof(struct linux_device_priv),
.device_handle_priv_size = sizeof(struct linux_device_handle_priv),
.transfer_priv_size = sizeof(struct linux_transfer_priv),
.add_iso_packet_size = 0,
};