freebsd-skq/lib/libusb/libusb20_ugen20.c
Hans Petter Selasky 34b0ca243f Implement new libusb v2.0 API function, libusb20_dev_get_stats().
This function is useful when debugging USB device issues.

MFC after:	1 week
Sponsored by:	Mellanox Technologies
2019-12-27 20:35:12 +00:00

1088 lines
25 KiB
C

/* $FreeBSD$ */
/*-
* SPDX-License-Identifier: BSD-2-Clause-FreeBSD
*
* Copyright (c) 2008 Hans Petter Selasky. All rights reserved.
*
* Redistribution and use in source and binary forms, with or without
* modification, are permitted provided that the following conditions
* are met:
* 1. Redistributions of source code must retain the above copyright
* notice, this list of conditions and the following disclaimer.
* 2. Redistributions in binary form must reproduce the above copyright
* notice, this list of conditions and the following disclaimer in the
* documentation and/or other materials provided with the distribution.
*
* THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
* ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
* IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
* ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
* FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
* DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
* OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
* HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
* LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
* OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
* SUCH DAMAGE.
*/
#ifdef LIBUSB_GLOBAL_INCLUDE_FILE
#include LIBUSB_GLOBAL_INCLUDE_FILE
#else
#include <errno.h>
#include <fcntl.h>
#include <stdio.h>
#include <stdlib.h>
#include <string.h>
#include <unistd.h>
#include <time.h>
#include <sys/queue.h>
#include <sys/types.h>
#endif
#include <dev/usb/usb.h>
#include <dev/usb/usbdi.h>
#include <dev/usb/usb_ioctl.h>
#include "libusb20.h"
#include "libusb20_desc.h"
#include "libusb20_int.h"
#ifndef IOUSB
#define IOUSB(a) a
#endif
static libusb20_init_backend_t ugen20_init_backend;
static libusb20_open_device_t ugen20_open_device;
static libusb20_close_device_t ugen20_close_device;
static libusb20_get_backend_name_t ugen20_get_backend_name;
static libusb20_exit_backend_t ugen20_exit_backend;
static libusb20_dev_get_iface_desc_t ugen20_dev_get_iface_desc;
static libusb20_dev_get_info_t ugen20_dev_get_info;
static libusb20_root_get_dev_quirk_t ugen20_root_get_dev_quirk;
static libusb20_root_get_quirk_name_t ugen20_root_get_quirk_name;
static libusb20_root_add_dev_quirk_t ugen20_root_add_dev_quirk;
static libusb20_root_remove_dev_quirk_t ugen20_root_remove_dev_quirk;
static libusb20_root_set_template_t ugen20_root_set_template;
static libusb20_root_get_template_t ugen20_root_get_template;
const struct libusb20_backend_methods libusb20_ugen20_backend = {
LIBUSB20_BACKEND(LIBUSB20_DECLARE, ugen20)
};
/* USB device specific */
static libusb20_get_config_desc_full_t ugen20_get_config_desc_full;
static libusb20_get_config_index_t ugen20_get_config_index;
static libusb20_set_config_index_t ugen20_set_config_index;
static libusb20_set_alt_index_t ugen20_set_alt_index;
static libusb20_reset_device_t ugen20_reset_device;
static libusb20_check_connected_t ugen20_check_connected;
static libusb20_set_power_mode_t ugen20_set_power_mode;
static libusb20_get_power_mode_t ugen20_get_power_mode;
static libusb20_get_power_usage_t ugen20_get_power_usage;
static libusb20_get_stats_t ugen20_get_stats;
static libusb20_kernel_driver_active_t ugen20_kernel_driver_active;
static libusb20_detach_kernel_driver_t ugen20_detach_kernel_driver;
static libusb20_do_request_sync_t ugen20_do_request_sync;
static libusb20_process_t ugen20_process;
/* USB transfer specific */
static libusb20_tr_open_t ugen20_tr_open;
static libusb20_tr_close_t ugen20_tr_close;
static libusb20_tr_clear_stall_sync_t ugen20_tr_clear_stall_sync;
static libusb20_tr_submit_t ugen20_tr_submit;
static libusb20_tr_cancel_async_t ugen20_tr_cancel_async;
static const struct libusb20_device_methods libusb20_ugen20_device_methods = {
LIBUSB20_DEVICE(LIBUSB20_DECLARE, ugen20)
};
static const char *
ugen20_get_backend_name(void)
{
return ("FreeBSD UGEN 2.0");
}
static uint32_t
ugen20_path_convert_one(const char **pp)
{
const char *ptr;
uint32_t temp = 0;
ptr = *pp;
while ((*ptr >= '0') && (*ptr <= '9')) {
temp *= 10;
temp += (*ptr - '0');
if (temp >= 1000000) {
/* catch overflow early */
return (0xFFFFFFFF);
}
ptr++;
}
if (*ptr == '.') {
/* skip dot */
ptr++;
}
*pp = ptr;
return (temp);
}
static int
ugen20_enumerate(struct libusb20_device *pdev, const char *id)
{
const char *tmp = id;
struct usb_device_descriptor ddesc;
struct usb_device_info devinfo;
struct usb_device_port_path udpp;
uint32_t plugtime;
char buf[64];
int f;
int error;
pdev->bus_number = ugen20_path_convert_one(&tmp);
pdev->device_address = ugen20_path_convert_one(&tmp);
snprintf(buf, sizeof(buf), "/dev/" USB_GENERIC_NAME "%u.%u",
pdev->bus_number, pdev->device_address);
f = open(buf, O_RDWR);
if (f < 0) {
return (LIBUSB20_ERROR_OTHER);
}
if (ioctl(f, IOUSB(USB_GET_PLUGTIME), &plugtime)) {
error = LIBUSB20_ERROR_OTHER;
goto done;
}
/* store when the device was plugged */
pdev->session_data.plugtime = plugtime;
if (ioctl(f, IOUSB(USB_GET_DEVICE_DESC), &ddesc)) {
error = LIBUSB20_ERROR_OTHER;
goto done;
}
LIBUSB20_INIT(LIBUSB20_DEVICE_DESC, &(pdev->ddesc));
libusb20_me_decode(&ddesc, sizeof(ddesc), &(pdev->ddesc));
if (pdev->ddesc.bNumConfigurations == 0) {
error = LIBUSB20_ERROR_OTHER;
goto done;
} else if (pdev->ddesc.bNumConfigurations >= 8) {
error = LIBUSB20_ERROR_OTHER;
goto done;
}
if (ioctl(f, IOUSB(USB_GET_DEVICEINFO), &devinfo)) {
error = LIBUSB20_ERROR_OTHER;
goto done;
}
switch (devinfo.udi_mode) {
case USB_MODE_DEVICE:
pdev->usb_mode = LIBUSB20_MODE_DEVICE;
break;
default:
pdev->usb_mode = LIBUSB20_MODE_HOST;
break;
}
switch (devinfo.udi_speed) {
case USB_SPEED_LOW:
pdev->usb_speed = LIBUSB20_SPEED_LOW;
break;
case USB_SPEED_FULL:
pdev->usb_speed = LIBUSB20_SPEED_FULL;
break;
case USB_SPEED_HIGH:
pdev->usb_speed = LIBUSB20_SPEED_HIGH;
break;
case USB_SPEED_VARIABLE:
pdev->usb_speed = LIBUSB20_SPEED_VARIABLE;
break;
case USB_SPEED_SUPER:
pdev->usb_speed = LIBUSB20_SPEED_SUPER;
break;
default:
pdev->usb_speed = LIBUSB20_SPEED_UNKNOWN;
break;
}
/* get parent HUB index and port */
pdev->parent_address = devinfo.udi_hubindex;
pdev->parent_port = devinfo.udi_hubport;
/* generate a nice description for printout */
snprintf(pdev->usb_desc, sizeof(pdev->usb_desc),
USB_GENERIC_NAME "%u.%u: <%s %s> at usbus%u", pdev->bus_number,
pdev->device_address, devinfo.udi_vendor,
devinfo.udi_product, pdev->bus_number);
/* get device port path, if any */
if (ioctl(f, IOUSB(USB_GET_DEV_PORT_PATH), &udpp) == 0 &&
udpp.udp_port_level < LIBUSB20_DEVICE_PORT_PATH_MAX) {
memcpy(pdev->port_path, udpp.udp_port_no, udpp.udp_port_level);
pdev->port_level = udpp.udp_port_level;
}
error = 0;
done:
close(f);
return (error);
}
struct ugen20_urd_state {
struct usb_read_dir urd;
uint32_t nparsed;
int f;
uint8_t *ptr;
const char *src;
const char *dst;
uint8_t buf[256];
uint8_t dummy_zero[1];
};
static int
ugen20_readdir(struct ugen20_urd_state *st)
{
; /* style fix */
repeat:
if (st->ptr == NULL) {
st->urd.urd_startentry += st->nparsed;
st->urd.urd_data = libusb20_pass_ptr(st->buf);
st->urd.urd_maxlen = sizeof(st->buf);
st->nparsed = 0;
if (ioctl(st->f, IOUSB(USB_READ_DIR), &st->urd)) {
return (EINVAL);
}
st->ptr = st->buf;
}
if (st->ptr[0] == 0) {
if (st->nparsed) {
st->ptr = NULL;
goto repeat;
} else {
return (ENXIO);
}
}
st->src = (void *)(st->ptr + 1);
st->dst = st->src + strlen(st->src) + 1;
st->ptr = st->ptr + st->ptr[0];
st->nparsed++;
if ((st->ptr < st->buf) ||
(st->ptr > st->dummy_zero)) {
/* invalid entry */
return (EINVAL);
}
return (0);
}
static int
ugen20_init_backend(struct libusb20_backend *pbe)
{
struct ugen20_urd_state state;
struct libusb20_device *pdev;
memset(&state, 0, sizeof(state));
state.f = open("/dev/" USB_DEVICE_NAME, O_RDONLY);
if (state.f < 0)
return (LIBUSB20_ERROR_OTHER);
while (ugen20_readdir(&state) == 0) {
if ((state.src[0] != 'u') ||
(state.src[1] != 'g') ||
(state.src[2] != 'e') ||
(state.src[3] != 'n')) {
continue;
}
pdev = libusb20_dev_alloc();
if (pdev == NULL) {
continue;
}
if (ugen20_enumerate(pdev, state.src + 4)) {
libusb20_dev_free(pdev);
continue;
}
/* put the device on the backend list */
libusb20_be_enqueue_device(pbe, pdev);
}
close(state.f);
return (0); /* success */
}
static void
ugen20_tr_release(struct libusb20_device *pdev)
{
struct usb_fs_uninit fs_uninit;
if (pdev->nTransfer == 0) {
return;
}
/* release all pending USB transfers */
if (pdev->privBeData != NULL) {
memset(&fs_uninit, 0, sizeof(fs_uninit));
if (ioctl(pdev->file, IOUSB(USB_FS_UNINIT), &fs_uninit)) {
/* ignore any errors of this kind */
}
}
return;
}
static int
ugen20_tr_renew(struct libusb20_device *pdev)
{
struct usb_fs_init fs_init;
struct usb_fs_endpoint *pfse;
int error;
uint32_t size;
uint16_t nMaxTransfer;
nMaxTransfer = pdev->nTransfer;
error = 0;
if (nMaxTransfer == 0) {
goto done;
}
size = nMaxTransfer * sizeof(*pfse);
if (pdev->privBeData == NULL) {
pfse = malloc(size);
if (pfse == NULL) {
error = LIBUSB20_ERROR_NO_MEM;
goto done;
}
pdev->privBeData = pfse;
}
/* reset endpoint data */
memset(pdev->privBeData, 0, size);
memset(&fs_init, 0, sizeof(fs_init));
fs_init.pEndpoints = libusb20_pass_ptr(pdev->privBeData);
fs_init.ep_index_max = nMaxTransfer;
if (ioctl(pdev->file, IOUSB(USB_FS_INIT), &fs_init)) {
error = LIBUSB20_ERROR_OTHER;
goto done;
}
done:
return (error);
}
static int
ugen20_open_device(struct libusb20_device *pdev, uint16_t nMaxTransfer)
{
uint32_t plugtime;
char buf[64];
int f;
int g;
int error;
snprintf(buf, sizeof(buf), "/dev/" USB_GENERIC_NAME "%u.%u",
pdev->bus_number, pdev->device_address);
/*
* We need two file handles, one for the control endpoint and one
* for BULK, INTERRUPT and ISOCHRONOUS transactions due to optimised
* kernel locking.
*/
g = open(buf, O_RDWR);
if (g < 0) {
return (LIBUSB20_ERROR_NO_DEVICE);
}
f = open(buf, O_RDWR);
if (f < 0) {
close(g);
return (LIBUSB20_ERROR_NO_DEVICE);
}
if (ioctl(f, IOUSB(USB_GET_PLUGTIME), &plugtime)) {
error = LIBUSB20_ERROR_OTHER;
goto done;
}
/* check that the correct device is still plugged */
if (pdev->session_data.plugtime != plugtime) {
error = LIBUSB20_ERROR_NO_DEVICE;
goto done;
}
/* need to set this before "tr_renew()" */
pdev->file = f;
pdev->file_ctrl = g;
/* renew all USB transfers */
error = ugen20_tr_renew(pdev);
if (error) {
goto done;
}
/* set methods */
pdev->methods = &libusb20_ugen20_device_methods;
done:
if (error) {
if (pdev->privBeData) {
/* cleanup after "tr_renew()" */
free(pdev->privBeData);
pdev->privBeData = NULL;
}
pdev->file = -1;
pdev->file_ctrl = -1;
close(f);
close(g);
}
return (error);
}
static int
ugen20_close_device(struct libusb20_device *pdev)
{
struct usb_fs_uninit fs_uninit;
if (pdev->privBeData) {
memset(&fs_uninit, 0, sizeof(fs_uninit));
if (ioctl(pdev->file, IOUSB(USB_FS_UNINIT), &fs_uninit)) {
/* ignore this error */
}
free(pdev->privBeData);
}
pdev->nTransfer = 0;
pdev->privBeData = NULL;
close(pdev->file);
close(pdev->file_ctrl);
pdev->file = -1;
pdev->file_ctrl = -1;
return (0); /* success */
}
static void
ugen20_exit_backend(struct libusb20_backend *pbe)
{
return; /* nothing to do */
}
static int
ugen20_get_config_desc_full(struct libusb20_device *pdev,
uint8_t **ppbuf, uint16_t *plen, uint8_t cfg_index)
{
struct usb_gen_descriptor gen_desc;
struct usb_config_descriptor cdesc;
uint8_t *ptr;
uint16_t len;
int error;
/* make sure memory is initialised */
memset(&cdesc, 0, sizeof(cdesc));
memset(&gen_desc, 0, sizeof(gen_desc));
gen_desc.ugd_data = libusb20_pass_ptr(&cdesc);
gen_desc.ugd_maxlen = sizeof(cdesc);
gen_desc.ugd_config_index = cfg_index;
error = ioctl(pdev->file_ctrl, IOUSB(USB_GET_FULL_DESC), &gen_desc);
if (error) {
return (LIBUSB20_ERROR_OTHER);
}
len = UGETW(cdesc.wTotalLength);
if (len < sizeof(cdesc)) {
/* corrupt descriptor */
return (LIBUSB20_ERROR_OTHER);
}
ptr = malloc(len);
if (!ptr) {
return (LIBUSB20_ERROR_NO_MEM);
}
/* make sure memory is initialised */
memset(ptr, 0, len);
gen_desc.ugd_data = libusb20_pass_ptr(ptr);
gen_desc.ugd_maxlen = len;
error = ioctl(pdev->file_ctrl, IOUSB(USB_GET_FULL_DESC), &gen_desc);
if (error) {
free(ptr);
return (LIBUSB20_ERROR_OTHER);
}
/* make sure that the device doesn't fool us */
memcpy(ptr, &cdesc, sizeof(cdesc));
*ppbuf = ptr;
*plen = len;
return (0); /* success */
}
static int
ugen20_get_config_index(struct libusb20_device *pdev, uint8_t *pindex)
{
int temp;
if (ioctl(pdev->file_ctrl, IOUSB(USB_GET_CONFIG), &temp)) {
return (LIBUSB20_ERROR_OTHER);
}
*pindex = temp;
return (0);
}
static int
ugen20_set_config_index(struct libusb20_device *pdev, uint8_t cfg_index)
{
int temp = cfg_index;
/* release all active USB transfers */
ugen20_tr_release(pdev);
if (ioctl(pdev->file_ctrl, IOUSB(USB_SET_CONFIG), &temp)) {
return (LIBUSB20_ERROR_OTHER);
}
return (ugen20_tr_renew(pdev));
}
static int
ugen20_set_alt_index(struct libusb20_device *pdev,
uint8_t iface_index, uint8_t alt_index)
{
struct usb_alt_interface alt_iface;
memset(&alt_iface, 0, sizeof(alt_iface));
alt_iface.uai_interface_index = iface_index;
alt_iface.uai_alt_index = alt_index;
/* release all active USB transfers */
ugen20_tr_release(pdev);
if (ioctl(pdev->file_ctrl, IOUSB(USB_SET_ALTINTERFACE), &alt_iface)) {
return (LIBUSB20_ERROR_OTHER);
}
return (ugen20_tr_renew(pdev));
}
static int
ugen20_reset_device(struct libusb20_device *pdev)
{
int temp = 0;
/* release all active USB transfers */
ugen20_tr_release(pdev);
if (ioctl(pdev->file_ctrl, IOUSB(USB_DEVICEENUMERATE), &temp)) {
return (LIBUSB20_ERROR_OTHER);
}
return (ugen20_tr_renew(pdev));
}
static int
ugen20_check_connected(struct libusb20_device *pdev)
{
uint32_t plugtime;
int error = 0;
if (ioctl(pdev->file_ctrl, IOUSB(USB_GET_PLUGTIME), &plugtime)) {
error = LIBUSB20_ERROR_NO_DEVICE;
goto done;
}
if (pdev->session_data.plugtime != plugtime) {
error = LIBUSB20_ERROR_NO_DEVICE;
goto done;
}
done:
return (error);
}
static int
ugen20_set_power_mode(struct libusb20_device *pdev, uint8_t power_mode)
{
int temp;
switch (power_mode) {
case LIBUSB20_POWER_OFF:
temp = USB_POWER_MODE_OFF;
break;
case LIBUSB20_POWER_ON:
temp = USB_POWER_MODE_ON;
break;
case LIBUSB20_POWER_SAVE:
temp = USB_POWER_MODE_SAVE;
break;
case LIBUSB20_POWER_SUSPEND:
temp = USB_POWER_MODE_SUSPEND;
break;
case LIBUSB20_POWER_RESUME:
temp = USB_POWER_MODE_RESUME;
break;
default:
return (LIBUSB20_ERROR_INVALID_PARAM);
}
if (ioctl(pdev->file_ctrl, IOUSB(USB_SET_POWER_MODE), &temp)) {
return (LIBUSB20_ERROR_OTHER);
}
return (0);
}
static int
ugen20_get_power_mode(struct libusb20_device *pdev, uint8_t *power_mode)
{
int temp;
if (ioctl(pdev->file_ctrl, IOUSB(USB_GET_POWER_MODE), &temp)) {
return (LIBUSB20_ERROR_OTHER);
}
switch (temp) {
case USB_POWER_MODE_OFF:
temp = LIBUSB20_POWER_OFF;
break;
case USB_POWER_MODE_ON:
temp = LIBUSB20_POWER_ON;
break;
case USB_POWER_MODE_SAVE:
temp = LIBUSB20_POWER_SAVE;
break;
case USB_POWER_MODE_SUSPEND:
temp = LIBUSB20_POWER_SUSPEND;
break;
case USB_POWER_MODE_RESUME:
temp = LIBUSB20_POWER_RESUME;
break;
default:
temp = LIBUSB20_POWER_ON;
break;
}
*power_mode = temp;
return (0); /* success */
}
static int
ugen20_get_power_usage(struct libusb20_device *pdev, uint16_t *power_usage)
{
int temp;
if (ioctl(pdev->file_ctrl, IOUSB(USB_GET_POWER_USAGE), &temp)) {
return (LIBUSB20_ERROR_OTHER);
}
*power_usage = temp;
return (0); /* success */
}
static int
ugen20_get_stats(struct libusb20_device *pdev, struct libusb20_device_stats *pstats)
{
struct usb_device_stats st;
if (ioctl(pdev->file_ctrl, IOUSB(USB_DEVICESTATS), &st))
return (LIBUSB20_ERROR_OTHER);
memset(pstats, 0, sizeof(*pstats));
pstats->xfer_ok[0] = st.uds_requests_ok[0];
pstats->xfer_ok[1] = st.uds_requests_ok[1];
pstats->xfer_ok[2] = st.uds_requests_ok[2];
pstats->xfer_ok[3] = st.uds_requests_ok[3];
pstats->xfer_fail[0] = st.uds_requests_fail[0];
pstats->xfer_fail[1] = st.uds_requests_fail[1];
pstats->xfer_fail[2] = st.uds_requests_fail[2];
pstats->xfer_fail[3] = st.uds_requests_fail[3];
return (0); /* success */
}
static int
ugen20_kernel_driver_active(struct libusb20_device *pdev,
uint8_t iface_index)
{
int temp = iface_index;
if (ioctl(pdev->file_ctrl, IOUSB(USB_IFACE_DRIVER_ACTIVE), &temp)) {
return (LIBUSB20_ERROR_OTHER);
}
return (0); /* kernel driver is active */
}
static int
ugen20_detach_kernel_driver(struct libusb20_device *pdev,
uint8_t iface_index)
{
int temp = iface_index;
if (ioctl(pdev->file_ctrl, IOUSB(USB_IFACE_DRIVER_DETACH), &temp)) {
return (LIBUSB20_ERROR_OTHER);
}
return (0); /* kernel driver is detached */
}
static int
ugen20_do_request_sync(struct libusb20_device *pdev,
struct LIBUSB20_CONTROL_SETUP_DECODED *setup,
void *data, uint16_t *pactlen, uint32_t timeout, uint8_t flags)
{
struct usb_ctl_request req;
memset(&req, 0, sizeof(req));
req.ucr_data = libusb20_pass_ptr(data);
if (!(flags & LIBUSB20_TRANSFER_SINGLE_SHORT_NOT_OK)) {
req.ucr_flags |= USB_SHORT_XFER_OK;
}
if (libusb20_me_encode(&req.ucr_request,
sizeof(req.ucr_request), setup)) {
/* ignore */
}
if (ioctl(pdev->file_ctrl, IOUSB(USB_DO_REQUEST), &req)) {
return (LIBUSB20_ERROR_OTHER);
}
if (pactlen) {
/* get actual length */
*pactlen = req.ucr_actlen;
}
return (0); /* request was successful */
}
static int
ugen20_process(struct libusb20_device *pdev)
{
struct usb_fs_complete temp;
struct usb_fs_endpoint *fsep;
struct libusb20_transfer *xfer;
while (1) {
if (ioctl(pdev->file, IOUSB(USB_FS_COMPLETE), &temp)) {
if (errno == EBUSY) {
break;
} else {
/* device detached */
return (LIBUSB20_ERROR_OTHER);
}
}
fsep = pdev->privBeData;
xfer = pdev->pTransfer;
fsep += temp.ep_index;
xfer += temp.ep_index;
/* update transfer status */
if (fsep->status == 0) {
xfer->aFrames = fsep->aFrames;
xfer->timeComplete = fsep->isoc_time_complete;
xfer->status = LIBUSB20_TRANSFER_COMPLETED;
} else if (fsep->status == USB_ERR_CANCELLED) {
xfer->aFrames = 0;
xfer->timeComplete = 0;
xfer->status = LIBUSB20_TRANSFER_CANCELLED;
} else if (fsep->status == USB_ERR_STALLED) {
xfer->aFrames = 0;
xfer->timeComplete = 0;
xfer->status = LIBUSB20_TRANSFER_STALL;
} else if (fsep->status == USB_ERR_TIMEOUT) {
xfer->aFrames = 0;
xfer->timeComplete = 0;
xfer->status = LIBUSB20_TRANSFER_TIMED_OUT;
} else {
xfer->aFrames = 0;
xfer->timeComplete = 0;
xfer->status = LIBUSB20_TRANSFER_ERROR;
}
libusb20_tr_callback_wrapper(xfer);
}
return (0); /* done */
}
static int
ugen20_tr_open(struct libusb20_transfer *xfer, uint32_t MaxBufSize,
uint32_t MaxFrameCount, uint8_t ep_no, uint16_t stream_id,
uint8_t pre_scale)
{
union {
struct usb_fs_open fs_open;
struct usb_fs_open_stream fs_open_stream;
} temp;
struct usb_fs_endpoint *fsep;
if (pre_scale)
MaxFrameCount |= USB_FS_MAX_FRAMES_PRE_SCALE;
memset(&temp, 0, sizeof(temp));
fsep = xfer->pdev->privBeData;
fsep += xfer->trIndex;
temp.fs_open.max_bufsize = MaxBufSize;
temp.fs_open.max_frames = MaxFrameCount;
temp.fs_open.ep_index = xfer->trIndex;
temp.fs_open.ep_no = ep_no;
if (stream_id != 0) {
temp.fs_open_stream.stream_id = stream_id;
if (ioctl(xfer->pdev->file, IOUSB(USB_FS_OPEN_STREAM), &temp.fs_open_stream))
return (LIBUSB20_ERROR_INVALID_PARAM);
} else {
if (ioctl(xfer->pdev->file, IOUSB(USB_FS_OPEN), &temp.fs_open))
return (LIBUSB20_ERROR_INVALID_PARAM);
}
/* maximums might have changed - update */
xfer->maxFrames = temp.fs_open.max_frames;
/* "max_bufsize" should be multiple of "max_packet_length" */
xfer->maxTotalLength = temp.fs_open.max_bufsize;
xfer->maxPacketLen = temp.fs_open.max_packet_length;
/* setup buffer and length lists using zero copy */
fsep->ppBuffer = libusb20_pass_ptr(xfer->ppBuffer);
fsep->pLength = libusb20_pass_ptr(xfer->pLength);
return (0); /* success */
}
static int
ugen20_tr_close(struct libusb20_transfer *xfer)
{
struct usb_fs_close temp;
memset(&temp, 0, sizeof(temp));
temp.ep_index = xfer->trIndex;
if (ioctl(xfer->pdev->file, IOUSB(USB_FS_CLOSE), &temp)) {
return (LIBUSB20_ERROR_INVALID_PARAM);
}
return (0); /* success */
}
static int
ugen20_tr_clear_stall_sync(struct libusb20_transfer *xfer)
{
struct usb_fs_clear_stall_sync temp;
memset(&temp, 0, sizeof(temp));
/* if the transfer is active, an error will be returned */
temp.ep_index = xfer->trIndex;
if (ioctl(xfer->pdev->file, IOUSB(USB_FS_CLEAR_STALL_SYNC), &temp)) {
return (LIBUSB20_ERROR_INVALID_PARAM);
}
return (0); /* success */
}
static void
ugen20_tr_submit(struct libusb20_transfer *xfer)
{
struct usb_fs_start temp;
struct usb_fs_endpoint *fsep;
memset(&temp, 0, sizeof(temp));
fsep = xfer->pdev->privBeData;
fsep += xfer->trIndex;
fsep->nFrames = xfer->nFrames;
fsep->flags = 0;
if (!(xfer->flags & LIBUSB20_TRANSFER_SINGLE_SHORT_NOT_OK)) {
fsep->flags |= USB_FS_FLAG_SINGLE_SHORT_OK;
}
if (!(xfer->flags & LIBUSB20_TRANSFER_MULTI_SHORT_NOT_OK)) {
fsep->flags |= USB_FS_FLAG_MULTI_SHORT_OK;
}
if (xfer->flags & LIBUSB20_TRANSFER_FORCE_SHORT) {
fsep->flags |= USB_FS_FLAG_FORCE_SHORT;
}
if (xfer->flags & LIBUSB20_TRANSFER_DO_CLEAR_STALL) {
fsep->flags |= USB_FS_FLAG_CLEAR_STALL;
}
/* NOTE: The "fsep->timeout" variable is 16-bit. */
if (xfer->timeout > 65535)
fsep->timeout = 65535;
else
fsep->timeout = xfer->timeout;
temp.ep_index = xfer->trIndex;
if (ioctl(xfer->pdev->file, IOUSB(USB_FS_START), &temp)) {
/* ignore any errors - should never happen */
}
return; /* success */
}
static void
ugen20_tr_cancel_async(struct libusb20_transfer *xfer)
{
struct usb_fs_stop temp;
memset(&temp, 0, sizeof(temp));
temp.ep_index = xfer->trIndex;
if (ioctl(xfer->pdev->file, IOUSB(USB_FS_STOP), &temp)) {
/* ignore any errors - should never happen */
}
return;
}
static int
ugen20_be_ioctl(uint32_t cmd, void *data)
{
int f;
int error;
f = open("/dev/" USB_DEVICE_NAME, O_RDONLY);
if (f < 0)
return (LIBUSB20_ERROR_OTHER);
error = ioctl(f, cmd, data);
if (error == -1) {
if (errno == EPERM) {
error = LIBUSB20_ERROR_ACCESS;
} else {
error = LIBUSB20_ERROR_OTHER;
}
}
close(f);
return (error);
}
static int
ugen20_dev_get_iface_desc(struct libusb20_device *pdev,
uint8_t iface_index, char *buf, uint8_t len)
{
struct usb_gen_descriptor ugd;
memset(&ugd, 0, sizeof(ugd));
ugd.ugd_data = libusb20_pass_ptr(buf);
ugd.ugd_maxlen = len;
ugd.ugd_iface_index = iface_index;
if (ioctl(pdev->file, IOUSB(USB_GET_IFACE_DRIVER), &ugd)) {
return (LIBUSB20_ERROR_INVALID_PARAM);
}
return (0);
}
static int
ugen20_dev_get_info(struct libusb20_device *pdev,
struct usb_device_info *pinfo)
{
if (ioctl(pdev->file, IOUSB(USB_GET_DEVICEINFO), pinfo)) {
return (LIBUSB20_ERROR_INVALID_PARAM);
}
return (0);
}
static int
ugen20_root_get_dev_quirk(struct libusb20_backend *pbe,
uint16_t quirk_index, struct libusb20_quirk *pq)
{
struct usb_gen_quirk q;
int error;
memset(&q, 0, sizeof(q));
q.index = quirk_index;
error = ugen20_be_ioctl(IOUSB(USB_DEV_QUIRK_GET), &q);
if (error) {
if (errno == EINVAL) {
return (LIBUSB20_ERROR_NOT_FOUND);
}
} else {
pq->vid = q.vid;
pq->pid = q.pid;
pq->bcdDeviceLow = q.bcdDeviceLow;
pq->bcdDeviceHigh = q.bcdDeviceHigh;
strlcpy(pq->quirkname, q.quirkname, sizeof(pq->quirkname));
}
return (error);
}
static int
ugen20_root_get_quirk_name(struct libusb20_backend *pbe, uint16_t quirk_index,
struct libusb20_quirk *pq)
{
struct usb_gen_quirk q;
int error;
memset(&q, 0, sizeof(q));
q.index = quirk_index;
error = ugen20_be_ioctl(IOUSB(USB_QUIRK_NAME_GET), &q);
if (error) {
if (errno == EINVAL) {
return (LIBUSB20_ERROR_NOT_FOUND);
}
} else {
strlcpy(pq->quirkname, q.quirkname, sizeof(pq->quirkname));
}
return (error);
}
static int
ugen20_root_add_dev_quirk(struct libusb20_backend *pbe,
struct libusb20_quirk *pq)
{
struct usb_gen_quirk q;
int error;
memset(&q, 0, sizeof(q));
q.vid = pq->vid;
q.pid = pq->pid;
q.bcdDeviceLow = pq->bcdDeviceLow;
q.bcdDeviceHigh = pq->bcdDeviceHigh;
strlcpy(q.quirkname, pq->quirkname, sizeof(q.quirkname));
error = ugen20_be_ioctl(IOUSB(USB_DEV_QUIRK_ADD), &q);
if (error) {
if (errno == ENOMEM) {
return (LIBUSB20_ERROR_NO_MEM);
}
}
return (error);
}
static int
ugen20_root_remove_dev_quirk(struct libusb20_backend *pbe,
struct libusb20_quirk *pq)
{
struct usb_gen_quirk q;
int error;
memset(&q, 0, sizeof(q));
q.vid = pq->vid;
q.pid = pq->pid;
q.bcdDeviceLow = pq->bcdDeviceLow;
q.bcdDeviceHigh = pq->bcdDeviceHigh;
strlcpy(q.quirkname, pq->quirkname, sizeof(q.quirkname));
error = ugen20_be_ioctl(IOUSB(USB_DEV_QUIRK_REMOVE), &q);
if (error) {
if (errno == EINVAL) {
return (LIBUSB20_ERROR_NOT_FOUND);
}
}
return (error);
}
static int
ugen20_root_set_template(struct libusb20_backend *pbe, int temp)
{
return (ugen20_be_ioctl(IOUSB(USB_SET_TEMPLATE), &temp));
}
static int
ugen20_root_get_template(struct libusb20_backend *pbe, int *ptemp)
{
return (ugen20_be_ioctl(IOUSB(USB_GET_TEMPLATE), ptemp));
}