usbhost.c revision 203f102028c4df33c191d8cd610775eba8d5366d
130ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood/* 230ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood * Copyright (C) 2010 The Android Open Source Project 330ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood * 430ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood * Licensed under the Apache License, Version 2.0 (the "License"); 530ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood * you may not use this file except in compliance with the License. 630ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood * You may obtain a copy of the License at 730ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood * 830ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood * http://www.apache.org/licenses/LICENSE-2.0 930ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood * 1030ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood * Unless required by applicable law or agreed to in writing, software 1130ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood * distributed under the License is distributed on an "AS IS" BASIS, 1230ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. 1330ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood * See the License for the specific language governing permissions and 1430ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood * limitations under the License. 1530ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood */ 1630ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 1730ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood#include <stdio.h> 1830ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood#include <stdlib.h> 1930ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood#include <unistd.h> 2030ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood#include <string.h> 2130ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 2230ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood#include <sys/ioctl.h> 2330ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood#include <sys/types.h> 2430ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood#include <sys/time.h> 2530ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood#include <sys/inotify.h> 2630ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood#include <dirent.h> 2730ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood#include <fcntl.h> 2830ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood#include <errno.h> 2930ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood#include <ctype.h> 3030ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood#include <pthread.h> 3130ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 3230ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood#include <linux/usbdevice_fs.h> 3330ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood#include <linux/version.h> 3430ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood#if LINUX_VERSION_CODE > KERNEL_VERSION(2, 6, 20) 3530ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood#include <linux/usb/ch9.h> 3630ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood#else 3730ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood#include <linux/usb_ch9.h> 3830ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood#endif 3930ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood#include <asm/byteorder.h> 4030ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 4130ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood#include "usbhost/usbhost.h" 4230ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 4330ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood#define USB_FS_DIR "/dev/bus/usb" 44203f102028c4df33c191d8cd610775eba8d5366dMike Lockwood#define USB_FS_ID_SCANNER "/dev/bus/usb/%d/%d" 4530ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 4630ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood#if 0 4730ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood#define D printf 4830ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood#else 4930ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood#define D(...) 5030ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood#endif 5130ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 526ac3aa157493ef24bc837b679dd8292fad8961e0Mike Lockwoodstruct usb_host_context { 536ac3aa157493ef24bc837b679dd8292fad8961e0Mike Lockwood usb_device_added_cb added_cb; 546ac3aa157493ef24bc837b679dd8292fad8961e0Mike Lockwood usb_device_removed_cb removed_cb; 556ac3aa157493ef24bc837b679dd8292fad8961e0Mike Lockwood void *client_data; 566ac3aa157493ef24bc837b679dd8292fad8961e0Mike Lockwood}; 576ac3aa157493ef24bc837b679dd8292fad8961e0Mike Lockwood 5830ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwoodstruct usb_device { 5930ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood char dev_name[64]; 6030ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood unsigned char desc[256]; 6130ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood int desc_length; 6230ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood int fd; 6330ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood int writeable; 6430ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood}; 6530ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 6630ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwoodstruct usb_endpoint 6730ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood{ 6830ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood struct usb_device *dev; 6930ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood struct usb_endpoint_descriptor desc; 7030ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood struct usbdevfs_urb urb; 7130ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood}; 7230ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 7330ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwoodstatic inline int badname(const char *name) 7430ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood{ 7530ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood while(*name) { 7630ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood if(!isdigit(*name++)) return 1; 7730ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood } 7830ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood return 0; 7930ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood} 8030ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 816ac3aa157493ef24bc837b679dd8292fad8961e0Mike Lockwoodstatic void find_existing_devices(struct usb_host_context *context) 8230ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood{ 8330ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood char busname[32], devname[32]; 8430ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood DIR *busdir , *devdir ; 8530ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood struct dirent *de; 8630ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 8730ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood busdir = opendir(USB_FS_DIR); 8830ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood if(busdir == 0) return; 8930ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 9030ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood while((de = readdir(busdir)) != 0) { 9130ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood if(badname(de->d_name)) continue; 9230ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 9330ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood snprintf(busname, sizeof busname, "%s/%s", USB_FS_DIR, de->d_name); 9430ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood devdir = opendir(busname); 9530ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood if(devdir == 0) continue; 9630ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 9730ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood while((de = readdir(devdir))) { 9830ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood if(badname(de->d_name)) continue; 9930ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 10030ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood snprintf(devname, sizeof devname, "%s/%s", busname, de->d_name); 1016ac3aa157493ef24bc837b679dd8292fad8961e0Mike Lockwood context->added_cb(devname, context->client_data); 10230ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood } // end of devdir while 10330ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood closedir(devdir); 10430ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood } //end of busdir while 10530ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood closedir(busdir); 10630ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood} 10730ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 1086ac3aa157493ef24bc837b679dd8292fad8961e0Mike Lockwoodstatic void* device_discovery_thread(void *client_data) 10930ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood{ 1106ac3aa157493ef24bc837b679dd8292fad8961e0Mike Lockwood struct usb_host_context *context = (struct usb_host_context *)client_data; 11130ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood struct inotify_event* event; 11230ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood char event_buf[512]; 11330ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood char path[100]; 11430ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood int i, fd, ret; 11530ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood int wd, wds[10]; 11630ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood int wd_count = sizeof(wds) / sizeof(wds[0]); 11730ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 11830ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood D("Created device discovery thread\n"); 11930ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 12030ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood fd = inotify_init(); 12130ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood if (fd < 0) { 12230ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood fprintf(stderr, "inotify_init failed\n"); 12330ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood return NULL; 12430ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood } 12530ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 12630ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood /* watch for files added and deleted within USB_FS_DIR */ 12730ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood memset(wds, 0, sizeof(wds)); 12830ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood /* watch the root for new subdirectories */ 12930ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood wds[0] = inotify_add_watch(fd, USB_FS_DIR, IN_CREATE | IN_DELETE); 13030ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood if (wds[0] < 0) { 13130ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood fprintf(stderr, "inotify_add_watch failed\n"); 13230ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood return NULL; 13330ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood } 13430ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 13530ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood /* watch existing subdirectories of USB_FS_DIR */ 13630ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood for (i = 1; i < wd_count; i++) { 13730ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood snprintf(path, sizeof(path), "%s/%03d", USB_FS_DIR, i); 13830ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood ret = inotify_add_watch(fd, path, IN_CREATE | IN_DELETE); 13930ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood if (ret > 0) 14030ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood wds[i] = ret; 14130ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood } 14230ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 14330ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood /* check for existing devices first, after we have inotify set up */ 1446ac3aa157493ef24bc837b679dd8292fad8961e0Mike Lockwood find_existing_devices(context); 14530ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 14630ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood while (1) { 14730ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood ret = read(fd, event_buf, sizeof(event_buf)); 14830ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood if (ret >= (int)sizeof(struct inotify_event)) { 14930ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood event = (struct inotify_event *)event_buf; 15030ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood wd = event->wd; 15130ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood if (wd == wds[0]) { 15230ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood i = atoi(event->name); 15330ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood snprintf(path, sizeof(path), "%s/%s", USB_FS_DIR, event->name); 15430ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood D("new subdirectory %s: index: %d\n", path, i); 15530ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood if (i > 0 && i < wd_count) { 15630ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood ret = inotify_add_watch(fd, path, IN_CREATE | IN_DELETE); 15730ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood if (ret > 0) 15830ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood wds[i] = ret; 15930ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood } 16030ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood } else { 16130ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood for (i = 1; i < wd_count; i++) { 16230ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood if (wd == wds[i]) { 16330ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood snprintf(path, sizeof(path), "%s/%03d/%s", USB_FS_DIR, i, event->name); 16430ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood if (event->mask == IN_CREATE) { 16530ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood D("new device %s\n", path); 1666ac3aa157493ef24bc837b679dd8292fad8961e0Mike Lockwood context->added_cb(path, context->client_data); 16730ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood } else if (event->mask == IN_DELETE) { 16830ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood D("gone device %s\n", path); 1696ac3aa157493ef24bc837b679dd8292fad8961e0Mike Lockwood context->removed_cb(path, context->client_data); 17030ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood } 17130ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood } 17230ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood } 17330ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood } 17430ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood } 17530ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood } 17630ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood return NULL; 17730ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood} 17830ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 1796ac3aa157493ef24bc837b679dd8292fad8961e0Mike Lockwoodint usb_host_init(usb_device_added_cb added_cb, usb_device_removed_cb removed_cb, void *client_data) 18030ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood{ 1816ac3aa157493ef24bc837b679dd8292fad8961e0Mike Lockwood struct usb_host_context *context; 18230ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood pthread_t tid; 1836ac3aa157493ef24bc837b679dd8292fad8961e0Mike Lockwood pthread_attr_t attr; 18430ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 1856ac3aa157493ef24bc837b679dd8292fad8961e0Mike Lockwood if (!added_cb || !removed_cb) 1866ac3aa157493ef24bc837b679dd8292fad8961e0Mike Lockwood return -EINVAL; 18730ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 1886ac3aa157493ef24bc837b679dd8292fad8961e0Mike Lockwood context = calloc(1, sizeof(struct usb_host_context)); 1896ac3aa157493ef24bc837b679dd8292fad8961e0Mike Lockwood context->added_cb = added_cb; 1906ac3aa157493ef24bc837b679dd8292fad8961e0Mike Lockwood context->removed_cb = removed_cb; 1916ac3aa157493ef24bc837b679dd8292fad8961e0Mike Lockwood context->client_data = client_data; 19230ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 1936ac3aa157493ef24bc837b679dd8292fad8961e0Mike Lockwood pthread_attr_init(&attr); 1946ac3aa157493ef24bc837b679dd8292fad8961e0Mike Lockwood pthread_attr_setdetachstate(&attr, PTHREAD_CREATE_DETACHED); 1956ac3aa157493ef24bc837b679dd8292fad8961e0Mike Lockwood return pthread_create(&tid, &attr, device_discovery_thread, context); 19630ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood} 19730ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 19830ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwoodstruct usb_device *usb_device_open(const char *dev_name) 19930ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood{ 20030ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood struct usb_device *device = calloc(1, sizeof(struct usb_device)); 20130ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood int fd, length, did_retry = 0; 20230ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 20330ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood strcpy(device->dev_name, dev_name); 20430ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood device->writeable = 1; 20530ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 20630ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwoodretry: 20730ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood fd = open(dev_name, O_RDWR); 20830ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood if (fd < 0) { 20930ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood /* if we fail, see if have read-only access */ 21030ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood fd = open(dev_name, O_RDONLY); 21130ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood if (fd < 0 && errno == EACCES && !did_retry) { 21230ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood /* work around race condition between inotify and permissions management */ 21330ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood sleep(1); 21430ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood did_retry = 1; 21530ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood goto retry; 21630ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood } 21730ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 21830ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood if (fd < 0) goto fail; 21930ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood device->writeable = 0; 22030ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood D("[ usb open read-only %s fd = %d]\n", dev_name, fd); 22130ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood } 22230ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 22330ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood length = read(fd, device->desc, sizeof(device->desc)); 22430ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood if (length < 0) 22530ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood goto fail; 22630ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 22730ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood device->fd = fd; 22830ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood device->desc_length = length; 22930ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood return device; 23030ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwoodfail: 23130ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood close(fd); 23230ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood free(device); 23330ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood return NULL; 23430ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood} 23530ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 23630ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwoodvoid usb_device_close(struct usb_device *device) 23730ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood{ 23830ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood close(device->fd); 23930ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood free(device); 24030ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood} 24130ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 24230ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwoodconst char* usb_device_get_name(struct usb_device *device) 24330ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood{ 24430ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood return device->dev_name; 24530ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood} 24630ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 247203f102028c4df33c191d8cd610775eba8d5366dMike Lockwoodint usb_device_get_unique_id(struct usb_device *device) 248203f102028c4df33c191d8cd610775eba8d5366dMike Lockwood{ 249203f102028c4df33c191d8cd610775eba8d5366dMike Lockwood int bus = 0, dev = 0; 250203f102028c4df33c191d8cd610775eba8d5366dMike Lockwood sscanf(device->dev_name, USB_FS_ID_SCANNER, &bus, &dev); 251203f102028c4df33c191d8cd610775eba8d5366dMike Lockwood return bus * 1000 + dev; 252203f102028c4df33c191d8cd610775eba8d5366dMike Lockwood} 253203f102028c4df33c191d8cd610775eba8d5366dMike Lockwood 25430ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwooduint16_t usb_device_get_vendor_id(struct usb_device *device) 25530ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood{ 25630ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood struct usb_device_descriptor* desc = (struct usb_device_descriptor*)device->desc; 25730ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood return __le16_to_cpu(desc->idVendor); 25830ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood} 25930ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 26030ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwooduint16_t usb_device_get_product_id(struct usb_device *device) 26130ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood{ 26230ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood struct usb_device_descriptor* desc = (struct usb_device_descriptor*)device->desc; 26330ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood return __le16_to_cpu(desc->idProduct); 26430ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood} 26530ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 26630ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwoodchar* usb_device_get_string(struct usb_device *device, int id) 26730ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood{ 26830ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood char string[256]; 26930ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood struct usbdevfs_ctrltransfer ctrl; 27030ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood __u16 buffer[128]; 27130ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood __u16 languages[128]; 27230ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood int i, result; 27330ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood int languageCount = 0; 27430ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 27530ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood string[0] = 0; 27630ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 27730ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood // reading the string requires read/write permission 27830ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood if (!device->writeable) { 27930ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood int fd = open(device->dev_name, O_RDWR); 28030ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood if (fd > 0) { 28130ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood close(device->fd); 28230ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood device->fd = fd; 28330ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood device->writeable = 1; 28430ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood } else { 28530ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood return NULL; 28630ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood } 28730ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood } 28830ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 28930ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood memset(languages, 0, sizeof(languages)); 29030ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood memset(&ctrl, 0, sizeof(ctrl)); 29130ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 29230ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood // read list of supported languages 29330ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood ctrl.bRequestType = USB_DIR_IN|USB_TYPE_STANDARD|USB_RECIP_DEVICE; 29430ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood ctrl.bRequest = USB_REQ_GET_DESCRIPTOR; 29530ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood ctrl.wValue = (USB_DT_STRING << 8) | 0; 29630ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood ctrl.wIndex = 0; 29730ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood ctrl.wLength = sizeof(languages); 29830ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood ctrl.data = languages; 29930ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 30030ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood result = ioctl(device->fd, USBDEVFS_CONTROL, &ctrl); 30130ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood if (result > 0) 30230ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood languageCount = (result - 2) / 2; 30330ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 30430ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood for (i = 1; i <= languageCount; i++) { 30530ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood memset(buffer, 0, sizeof(buffer)); 30630ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood memset(&ctrl, 0, sizeof(ctrl)); 30730ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 30830ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood ctrl.bRequestType = USB_DIR_IN|USB_TYPE_STANDARD|USB_RECIP_DEVICE; 30930ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood ctrl.bRequest = USB_REQ_GET_DESCRIPTOR; 31030ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood ctrl.wValue = (USB_DT_STRING << 8) | id; 31130ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood ctrl.wIndex = languages[i]; 31230ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood ctrl.wLength = sizeof(buffer); 31330ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood ctrl.data = buffer; 31430ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 31530ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood result = ioctl(device->fd, USBDEVFS_CONTROL, &ctrl); 31630ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood if (result > 0) { 31730ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood int i; 31830ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood // skip first word, and copy the rest to the string, changing shorts to bytes. 31930ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood result /= 2; 32030ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood for (i = 1; i < result; i++) 32130ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood string[i - 1] = buffer[i]; 32230ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood string[i - 1] = 0; 32330ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood return strdup(string); 32430ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood } 32530ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood } 32630ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 32730ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood return NULL; 32830ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood} 32930ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 33030ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwoodchar* usb_device_get_manufacturer_name(struct usb_device *device) 33130ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood{ 33230ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood struct usb_device_descriptor *desc = (struct usb_device_descriptor *)device->desc; 33330ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 33430ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood if (desc->iManufacturer) 33530ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood return usb_device_get_string(device, desc->iManufacturer); 33630ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood else 33730ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood return NULL; 33830ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood} 33930ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 34030ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwoodchar* usb_device_get_product_name(struct usb_device *device) 34130ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood{ 34230ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood struct usb_device_descriptor *desc = (struct usb_device_descriptor *)device->desc; 34330ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 34430ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood if (desc->iProduct) 34530ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood return usb_device_get_string(device, desc->iProduct); 34630ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood else 34730ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood return NULL; 34830ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood} 34930ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 35030ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwoodchar* usb_device_get_serial(struct usb_device *device) 35130ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood{ 35230ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood struct usb_device_descriptor *desc = (struct usb_device_descriptor *)device->desc; 35330ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 35430ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood if (desc->iSerialNumber) 35530ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood return usb_device_get_string(device, desc->iSerialNumber); 35630ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood else 35730ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood return NULL; 35830ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood} 35930ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 36030ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwoodint usb_device_is_writeable(struct usb_device *device) 36130ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood{ 36230ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood return device->writeable; 36330ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood} 36430ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 36530ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwoodvoid usb_descriptor_iter_init(struct usb_device *device, struct usb_descriptor_iter *iter) 36630ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood{ 36730ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood iter->config = device->desc; 36830ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood iter->config_end = device->desc + device->desc_length; 36930ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood iter->curr_desc = device->desc; 37030ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood} 37130ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 37230ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwoodstruct usb_descriptor_header *usb_descriptor_iter_next(struct usb_descriptor_iter *iter) 37330ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood{ 37430ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood struct usb_descriptor_header* next; 37530ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood if (iter->curr_desc >= iter->config_end) 37630ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood return NULL; 37730ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood next = (struct usb_descriptor_header*)iter->curr_desc; 37830ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood iter->curr_desc += next->bLength; 37930ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood return next; 38030ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood} 38130ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 38230ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwoodint usb_device_claim_interface(struct usb_device *device, unsigned int interface) 38330ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood{ 38430ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood return ioctl(device->fd, USBDEVFS_CLAIMINTERFACE, &interface); 38530ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood} 38630ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 38730ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwoodint usb_device_release_interface(struct usb_device *device, unsigned int interface) 38830ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood{ 38930ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood return ioctl(device->fd, USBDEVFS_RELEASEINTERFACE, &interface); 39030ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood} 39130ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 39230ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwoodstruct usb_endpoint *usb_endpoint_open(struct usb_device *dev, 39330ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood const struct usb_endpoint_descriptor *desc) 39430ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood{ 39530ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood struct usb_endpoint *ep = calloc(1, sizeof(struct usb_endpoint)); 39630ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood memcpy(&ep->desc, desc, sizeof(ep->desc)); 39730ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood ep->dev = dev; 39830ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood return ep; 39930ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood} 40030ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 40130ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwoodvoid usb_endpoint_close(struct usb_endpoint *ep) 40230ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood{ 40330ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood // cancel IO here? 40430ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood free(ep); 40530ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood} 40630ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 40730ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwoodint usb_endpoint_queue(struct usb_endpoint *ep, void *data, int len) 40830ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood{ 40930ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood struct usbdevfs_urb *urb = &ep->urb; 41030ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood int res; 41130ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 41230ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood D("usb_endpoint_queue\n"); 41330ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood memset(urb, 0, sizeof(*urb)); 41430ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood urb->type = USBDEVFS_URB_TYPE_BULK; 41530ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood urb->endpoint = ep->desc.bEndpointAddress; 41630ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood urb->status = -1; 41730ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood urb->buffer = data; 41830ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood urb->buffer_length = len; 41930ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 42030ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood do { 42130ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood res = ioctl(ep->dev->fd, USBDEVFS_SUBMITURB, urb); 42230ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood } while((res < 0) && (errno == EINTR)); 42330ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 42430ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood return res; 42530ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood} 42630ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 42730ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwoodint usb_endpoint_wait(struct usb_device *dev, int *out_ep_num) 42830ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood{ 42930ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood struct usbdevfs_urb *out = NULL; 43030ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood int res; 43130ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 43230ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood while (1) { 43330ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood res = ioctl(dev->fd, USBDEVFS_REAPURB, &out); 43430ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood D("USBDEVFS_REAPURB returned %d\n", res); 43530ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood if (res < 0) { 43630ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood if(errno == EINTR) { 43730ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood continue; 43830ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood } 43930ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood D("[ reap urb - error ]\n"); 44030ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood *out_ep_num = -1; 44130ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood } else { 44230ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood D("[ urb @%p status = %d, actual = %d ]\n", 44330ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood out, out->status, out->actual_length); 44430ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood res = out->actual_length; 44530ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood *out_ep_num = out->endpoint; 44630ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood } 44730ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood break; 44830ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood } 44930ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood return res; 45030ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood} 45130ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 45230ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwoodint usb_endpoint_cancel(struct usb_endpoint *ep) 45330ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood{ 45430ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood return ioctl(ep->dev->fd, USBDEVFS_DISCARDURB, &ep->urb); 45530ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood} 45630ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 4575e567cb34b5e54467f501fc9703db82ca6639ff3Mike Lockwoodstruct usb_device *usb_endpoint_get_device(struct usb_endpoint *ep) 4585e567cb34b5e54467f501fc9703db82ca6639ff3Mike Lockwood{ 4595e567cb34b5e54467f501fc9703db82ca6639ff3Mike Lockwood return ep->dev; 4605e567cb34b5e54467f501fc9703db82ca6639ff3Mike Lockwood} 4615e567cb34b5e54467f501fc9703db82ca6639ff3Mike Lockwood 46230ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwoodint usb_endpoint_number(struct usb_endpoint *ep) 46330ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood{ 46430ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood return ep->desc.bEndpointAddress; 46530ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood} 46630ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 46730ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwoodint usb_endpoint_max_packet(struct usb_endpoint *ep) 46830ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood{ 46930ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood return __le16_to_cpu(ep->desc.wMaxPacketSize); 47030ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood} 47130ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 472