Mainly focus on files that use BSD 2-Clause license, however the tool I was using mis-identified many licenses so this was mostly a manual - error prone - task. The Software Package Data Exchange (SPDX) group provides a specification to make it easier for automated tools to detect and summarize well known opensource licenses. We are gradually adopting the specification, noting that the tags are considered only advisory and do not, in any way, superceed or replace the license texts.
1073 lines
25 KiB
C
1073 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_port_path_t ugen20_get_port_path;
|
|
static libusb20_get_power_usage_t ugen20_get_power_usage;
|
|
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;
|
|
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);
|
|
|
|
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_port_path(struct libusb20_device *pdev, uint8_t *buf, uint8_t bufsize)
|
|
{
|
|
struct usb_device_port_path udpp;
|
|
|
|
if (ioctl(pdev->file_ctrl, IOUSB(USB_GET_DEV_PORT_PATH), &udpp))
|
|
return (LIBUSB20_ERROR_OTHER);
|
|
|
|
if (udpp.udp_port_level > bufsize)
|
|
return (LIBUSB20_ERROR_OVERFLOW);
|
|
|
|
memcpy(buf, udpp.udp_port_no, udpp.udp_port_level);
|
|
|
|
return (udpp.udp_port_level); /* 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_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));
|
|
}
|