usbhost.c revision 7d700f8bdce747a26e3ee4737683194d77286ba3
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 17e15af09876c5e0301084f46b8036aed147cf9c24Mike Lockwood// #define DEBUG 1 18e15af09876c5e0301084f46b8036aed147cf9c24Mike Lockwood#if DEBUG 19e15af09876c5e0301084f46b8036aed147cf9c24Mike Lockwood 20e15af09876c5e0301084f46b8036aed147cf9c24Mike Lockwood#ifdef USE_LIBLOG 21e15af09876c5e0301084f46b8036aed147cf9c24Mike Lockwood#define LOG_TAG "usbhost" 22e15af09876c5e0301084f46b8036aed147cf9c24Mike Lockwood#include "utils/Log.h" 23e15af09876c5e0301084f46b8036aed147cf9c24Mike Lockwood#define D LOGD 24e15af09876c5e0301084f46b8036aed147cf9c24Mike Lockwood#else 25e15af09876c5e0301084f46b8036aed147cf9c24Mike Lockwood#define D printf 26e15af09876c5e0301084f46b8036aed147cf9c24Mike Lockwood#endif 27e15af09876c5e0301084f46b8036aed147cf9c24Mike Lockwood 28e15af09876c5e0301084f46b8036aed147cf9c24Mike Lockwood#else 29e15af09876c5e0301084f46b8036aed147cf9c24Mike Lockwood#define D(...) 30e15af09876c5e0301084f46b8036aed147cf9c24Mike Lockwood#endif 31e15af09876c5e0301084f46b8036aed147cf9c24Mike Lockwood 3230ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood#include <stdio.h> 3330ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood#include <stdlib.h> 3430ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood#include <unistd.h> 3530ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood#include <string.h> 3630ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 3730ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood#include <sys/ioctl.h> 3830ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood#include <sys/types.h> 3930ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood#include <sys/time.h> 4030ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood#include <sys/inotify.h> 4130ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood#include <dirent.h> 4230ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood#include <fcntl.h> 4330ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood#include <errno.h> 4430ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood#include <ctype.h> 4530ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood#include <pthread.h> 4630ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 4730ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood#include <linux/usbdevice_fs.h> 4830ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood#include <linux/version.h> 4930ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood#if LINUX_VERSION_CODE > KERNEL_VERSION(2, 6, 20) 5030ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood#include <linux/usb/ch9.h> 5130ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood#else 5230ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood#include <linux/usb_ch9.h> 5330ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood#endif 5430ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood#include <asm/byteorder.h> 5530ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 5630ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood#include "usbhost/usbhost.h" 5730ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 5830ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood#define USB_FS_DIR "/dev/bus/usb" 59203f102028c4df33c191d8cd610775eba8d5366dMike Lockwood#define USB_FS_ID_SCANNER "/dev/bus/usb/%d/%d" 607d700f8bdce747a26e3ee4737683194d77286ba3Mike Lockwood#define USB_FS_ID_FORMAT "/dev/bus/usb/%03d/%03d" 6130ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 6230ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 636ac3aa157493ef24bc837b679dd8292fad8961e0Mike Lockwoodstruct usb_host_context { 647a96ba436c9a2bacc64e712bdb53bd7accc5c3a9Mike Lockwood int fd; 656ac3aa157493ef24bc837b679dd8292fad8961e0Mike Lockwood}; 666ac3aa157493ef24bc837b679dd8292fad8961e0Mike Lockwood 6730ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwoodstruct usb_device { 6830ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood char dev_name[64]; 6930ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood unsigned char desc[256]; 7030ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood int desc_length; 7130ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood int fd; 7230ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood int writeable; 7330ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood}; 7430ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 7530ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwoodstruct usb_endpoint 7630ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood{ 7730ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood struct usb_device *dev; 7830ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood struct usb_endpoint_descriptor desc; 7930ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood struct usbdevfs_urb urb; 8030ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood}; 8130ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 8230ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwoodstatic inline int badname(const char *name) 8330ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood{ 8430ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood while(*name) { 8530ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood if(!isdigit(*name++)) return 1; 8630ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood } 8730ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood return 0; 8830ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood} 8930ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 907a96ba436c9a2bacc64e712bdb53bd7accc5c3a9Mike Lockwood/* returns true if one of the callbacks indicates we are done */ 917a96ba436c9a2bacc64e712bdb53bd7accc5c3a9Mike Lockwoodstatic int find_existing_devices(usb_device_added_cb added_cb, 927a96ba436c9a2bacc64e712bdb53bd7accc5c3a9Mike Lockwood usb_device_removed_cb removed_cb, 937a96ba436c9a2bacc64e712bdb53bd7accc5c3a9Mike Lockwood void *client_data) 9430ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood{ 9530ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood char busname[32], devname[32]; 9630ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood DIR *busdir , *devdir ; 9730ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood struct dirent *de; 987a96ba436c9a2bacc64e712bdb53bd7accc5c3a9Mike Lockwood int done = 0; 9930ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 10030ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood busdir = opendir(USB_FS_DIR); 1017a96ba436c9a2bacc64e712bdb53bd7accc5c3a9Mike Lockwood if(busdir == 0) return 1; 10230ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 1037a96ba436c9a2bacc64e712bdb53bd7accc5c3a9Mike Lockwood while ((de = readdir(busdir)) != 0 && !done) { 10430ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood if(badname(de->d_name)) continue; 10530ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 10630ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood snprintf(busname, sizeof busname, "%s/%s", USB_FS_DIR, de->d_name); 10730ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood devdir = opendir(busname); 10830ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood if(devdir == 0) continue; 10930ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 1107a96ba436c9a2bacc64e712bdb53bd7accc5c3a9Mike Lockwood while ((de = readdir(devdir)) && !done) { 11130ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood if(badname(de->d_name)) continue; 11230ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 11330ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood snprintf(devname, sizeof devname, "%s/%s", busname, de->d_name); 1147a96ba436c9a2bacc64e712bdb53bd7accc5c3a9Mike Lockwood done = added_cb(devname, client_data); 11530ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood } // end of devdir while 11630ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood closedir(devdir); 11730ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood } //end of busdir while 11830ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood closedir(busdir); 1197a96ba436c9a2bacc64e712bdb53bd7accc5c3a9Mike Lockwood 1207a96ba436c9a2bacc64e712bdb53bd7accc5c3a9Mike Lockwood return done; 1217a96ba436c9a2bacc64e712bdb53bd7accc5c3a9Mike Lockwood} 1227a96ba436c9a2bacc64e712bdb53bd7accc5c3a9Mike Lockwood 1237a96ba436c9a2bacc64e712bdb53bd7accc5c3a9Mike Lockwoodstruct usb_host_context *usb_host_init() 1247a96ba436c9a2bacc64e712bdb53bd7accc5c3a9Mike Lockwood{ 1257a96ba436c9a2bacc64e712bdb53bd7accc5c3a9Mike Lockwood struct usb_host_context *context = calloc(1, sizeof(struct usb_host_context)); 1267a96ba436c9a2bacc64e712bdb53bd7accc5c3a9Mike Lockwood if (!context) { 1277a96ba436c9a2bacc64e712bdb53bd7accc5c3a9Mike Lockwood fprintf(stderr, "out of memory in usb_host_context\n"); 1287a96ba436c9a2bacc64e712bdb53bd7accc5c3a9Mike Lockwood return NULL; 1297a96ba436c9a2bacc64e712bdb53bd7accc5c3a9Mike Lockwood } 1307a96ba436c9a2bacc64e712bdb53bd7accc5c3a9Mike Lockwood context->fd = inotify_init(); 1317a96ba436c9a2bacc64e712bdb53bd7accc5c3a9Mike Lockwood if (context->fd < 0) { 1327a96ba436c9a2bacc64e712bdb53bd7accc5c3a9Mike Lockwood fprintf(stderr, "inotify_init failed\n"); 1337a96ba436c9a2bacc64e712bdb53bd7accc5c3a9Mike Lockwood free(context); 1347a96ba436c9a2bacc64e712bdb53bd7accc5c3a9Mike Lockwood return NULL; 1357a96ba436c9a2bacc64e712bdb53bd7accc5c3a9Mike Lockwood } 1367a96ba436c9a2bacc64e712bdb53bd7accc5c3a9Mike Lockwood return context; 1377a96ba436c9a2bacc64e712bdb53bd7accc5c3a9Mike Lockwood} 1387a96ba436c9a2bacc64e712bdb53bd7accc5c3a9Mike Lockwood 1397a96ba436c9a2bacc64e712bdb53bd7accc5c3a9Mike Lockwoodvoid usb_host_cleanup(struct usb_host_context *context) 1407a96ba436c9a2bacc64e712bdb53bd7accc5c3a9Mike Lockwood{ 1417a96ba436c9a2bacc64e712bdb53bd7accc5c3a9Mike Lockwood close(context->fd); 1427a96ba436c9a2bacc64e712bdb53bd7accc5c3a9Mike Lockwood free(context); 14330ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood} 14430ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 1457a96ba436c9a2bacc64e712bdb53bd7accc5c3a9Mike Lockwoodvoid usb_host_run(struct usb_host_context *context, 1467a96ba436c9a2bacc64e712bdb53bd7accc5c3a9Mike Lockwood usb_device_added_cb added_cb, 1477a96ba436c9a2bacc64e712bdb53bd7accc5c3a9Mike Lockwood usb_device_removed_cb removed_cb, 148a805519ceedc53afa5453a6d8a7d80038d885d9fMike Lockwood usb_discovery_done_cb discovery_done_cb, 1497a96ba436c9a2bacc64e712bdb53bd7accc5c3a9Mike Lockwood void *client_data) 15030ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood{ 15130ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood struct inotify_event* event; 15230ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood char event_buf[512]; 15330ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood char path[100]; 1547a96ba436c9a2bacc64e712bdb53bd7accc5c3a9Mike Lockwood int i, ret, done = 0; 15530ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood int wd, wds[10]; 15630ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood int wd_count = sizeof(wds) / sizeof(wds[0]); 15730ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 15830ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood D("Created device discovery thread\n"); 15930ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 16030ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood /* watch for files added and deleted within USB_FS_DIR */ 16130ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood memset(wds, 0, sizeof(wds)); 16230ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood /* watch the root for new subdirectories */ 1637a96ba436c9a2bacc64e712bdb53bd7accc5c3a9Mike Lockwood wds[0] = inotify_add_watch(context->fd, USB_FS_DIR, IN_CREATE | IN_DELETE); 16430ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood if (wds[0] < 0) { 16530ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood fprintf(stderr, "inotify_add_watch failed\n"); 166e8849d190a3097274dcb64416e564538a1017054Mike Lockwood if (discovery_done_cb) 167e8849d190a3097274dcb64416e564538a1017054Mike Lockwood discovery_done_cb(client_data); 1687a96ba436c9a2bacc64e712bdb53bd7accc5c3a9Mike Lockwood return; 16930ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood } 17030ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 17130ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood /* watch existing subdirectories of USB_FS_DIR */ 17230ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood for (i = 1; i < wd_count; i++) { 17330ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood snprintf(path, sizeof(path), "%s/%03d", USB_FS_DIR, i); 1747a96ba436c9a2bacc64e712bdb53bd7accc5c3a9Mike Lockwood ret = inotify_add_watch(context->fd, path, IN_CREATE | IN_DELETE); 17530ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood if (ret > 0) 17630ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood wds[i] = ret; 17730ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood } 17830ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 17930ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood /* check for existing devices first, after we have inotify set up */ 1807a96ba436c9a2bacc64e712bdb53bd7accc5c3a9Mike Lockwood done = find_existing_devices(added_cb, removed_cb, client_data); 181a805519ceedc53afa5453a6d8a7d80038d885d9fMike Lockwood if (discovery_done_cb) 182a805519ceedc53afa5453a6d8a7d80038d885d9fMike Lockwood done |= discovery_done_cb(client_data); 18330ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 1847a96ba436c9a2bacc64e712bdb53bd7accc5c3a9Mike Lockwood while (!done) { 1857a96ba436c9a2bacc64e712bdb53bd7accc5c3a9Mike Lockwood ret = read(context->fd, event_buf, sizeof(event_buf)); 18630ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood if (ret >= (int)sizeof(struct inotify_event)) { 18730ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood event = (struct inotify_event *)event_buf; 18830ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood wd = event->wd; 18930ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood if (wd == wds[0]) { 19030ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood i = atoi(event->name); 19130ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood snprintf(path, sizeof(path), "%s/%s", USB_FS_DIR, event->name); 19230ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood D("new subdirectory %s: index: %d\n", path, i); 19330ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood if (i > 0 && i < wd_count) { 1947a96ba436c9a2bacc64e712bdb53bd7accc5c3a9Mike Lockwood ret = inotify_add_watch(context->fd, path, IN_CREATE | IN_DELETE); 19530ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood if (ret > 0) 19630ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood wds[i] = ret; 19730ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood } 19830ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood } else { 1997a96ba436c9a2bacc64e712bdb53bd7accc5c3a9Mike Lockwood for (i = 1; i < wd_count && !done; i++) { 20030ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood if (wd == wds[i]) { 20130ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood snprintf(path, sizeof(path), "%s/%03d/%s", USB_FS_DIR, i, event->name); 20230ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood if (event->mask == IN_CREATE) { 20330ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood D("new device %s\n", path); 2047a96ba436c9a2bacc64e712bdb53bd7accc5c3a9Mike Lockwood done = added_cb(path, client_data); 20530ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood } else if (event->mask == IN_DELETE) { 20630ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood D("gone device %s\n", path); 2077a96ba436c9a2bacc64e712bdb53bd7accc5c3a9Mike Lockwood done = removed_cb(path, client_data); 20830ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood } 20930ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood } 21030ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood } 21130ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood } 21230ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood } 21330ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood } 21430ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood} 21530ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 21630ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwoodstruct usb_device *usb_device_open(const char *dev_name) 21730ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood{ 218cd185f23cc6f062b252d1d19bca55e721290ee62Mike Lockwood int fd, did_retry = 0, writeable = 1; 21930ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 22030ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwoodretry: 22130ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood fd = open(dev_name, O_RDWR); 22230ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood if (fd < 0) { 22330ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood /* if we fail, see if have read-only access */ 22430ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood fd = open(dev_name, O_RDONLY); 225e15af09876c5e0301084f46b8036aed147cf9c24Mike Lockwood D("usb_device_open open returned %d errno %d\n", fd, errno); 226e15af09876c5e0301084f46b8036aed147cf9c24Mike Lockwood if (fd < 0 && (errno == EACCES || errno == ENOENT) && !did_retry) { 22730ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood /* work around race condition between inotify and permissions management */ 22830ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood sleep(1); 22930ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood did_retry = 1; 23030ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood goto retry; 23130ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood } 23230ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 233cd185f23cc6f062b252d1d19bca55e721290ee62Mike Lockwood if (fd < 0) 234cd185f23cc6f062b252d1d19bca55e721290ee62Mike Lockwood return NULL; 235cd185f23cc6f062b252d1d19bca55e721290ee62Mike Lockwood writeable = 0; 23630ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood D("[ usb open read-only %s fd = %d]\n", dev_name, fd); 23730ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood } 23830ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 239cd185f23cc6f062b252d1d19bca55e721290ee62Mike Lockwood struct usb_device* result = usb_device_new(dev_name, fd); 240cd185f23cc6f062b252d1d19bca55e721290ee62Mike Lockwood if (result) 241cd185f23cc6f062b252d1d19bca55e721290ee62Mike Lockwood result->writeable = writeable; 242cd185f23cc6f062b252d1d19bca55e721290ee62Mike Lockwood return result; 243cd185f23cc6f062b252d1d19bca55e721290ee62Mike Lockwood} 244cd185f23cc6f062b252d1d19bca55e721290ee62Mike Lockwood 245cd185f23cc6f062b252d1d19bca55e721290ee62Mike Lockwoodvoid usb_device_close(struct usb_device *device) 246cd185f23cc6f062b252d1d19bca55e721290ee62Mike Lockwood{ 247cd185f23cc6f062b252d1d19bca55e721290ee62Mike Lockwood close(device->fd); 248cd185f23cc6f062b252d1d19bca55e721290ee62Mike Lockwood free(device); 249cd185f23cc6f062b252d1d19bca55e721290ee62Mike Lockwood} 250cd185f23cc6f062b252d1d19bca55e721290ee62Mike Lockwood 251cd185f23cc6f062b252d1d19bca55e721290ee62Mike Lockwoodstruct usb_device *usb_device_new(const char *dev_name, int fd) 252cd185f23cc6f062b252d1d19bca55e721290ee62Mike Lockwood{ 253cd185f23cc6f062b252d1d19bca55e721290ee62Mike Lockwood struct usb_device *device = calloc(1, sizeof(struct usb_device)); 254cd185f23cc6f062b252d1d19bca55e721290ee62Mike Lockwood int length; 255cd185f23cc6f062b252d1d19bca55e721290ee62Mike Lockwood 256cd185f23cc6f062b252d1d19bca55e721290ee62Mike Lockwood if (lseek(fd, 0, SEEK_SET) != 0) 257cd185f23cc6f062b252d1d19bca55e721290ee62Mike Lockwood goto failed; 25830ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood length = read(fd, device->desc, sizeof(device->desc)); 259cd185f23cc6f062b252d1d19bca55e721290ee62Mike Lockwood D("usb_device_new read returned %d errno %d\n", fd, errno); 26030ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood if (length < 0) 261cd185f23cc6f062b252d1d19bca55e721290ee62Mike Lockwood goto failed; 26230ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 26393aff72d9b469f4b77468bab654cd65243b662e6Mike Lockwood strncpy(device->dev_name, dev_name, sizeof(device->dev_name) - 1); 26430ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood device->fd = fd; 26530ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood device->desc_length = length; 266cd185f23cc6f062b252d1d19bca55e721290ee62Mike Lockwood // assume we are writeable, since usb_device_get_fd will only return writeable fds 267cd185f23cc6f062b252d1d19bca55e721290ee62Mike Lockwood device->writeable = 1; 26830ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood return device; 269cd185f23cc6f062b252d1d19bca55e721290ee62Mike Lockwood 270cd185f23cc6f062b252d1d19bca55e721290ee62Mike Lockwoodfailed: 27130ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood close(fd); 27230ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood free(device); 27330ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood return NULL; 27430ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood} 27530ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 276cd185f23cc6f062b252d1d19bca55e721290ee62Mike Lockwoodstatic int usb_device_reopen_writeable(struct usb_device *device) 27730ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood{ 278cd185f23cc6f062b252d1d19bca55e721290ee62Mike Lockwood if (device->writeable) 279cd185f23cc6f062b252d1d19bca55e721290ee62Mike Lockwood return 1; 280cd185f23cc6f062b252d1d19bca55e721290ee62Mike Lockwood 281cd185f23cc6f062b252d1d19bca55e721290ee62Mike Lockwood int fd = open(device->dev_name, O_RDWR); 282cd185f23cc6f062b252d1d19bca55e721290ee62Mike Lockwood if (fd >= 0) { 283cd185f23cc6f062b252d1d19bca55e721290ee62Mike Lockwood close(device->fd); 284cd185f23cc6f062b252d1d19bca55e721290ee62Mike Lockwood device->fd = fd; 285cd185f23cc6f062b252d1d19bca55e721290ee62Mike Lockwood device->writeable = 1; 286cd185f23cc6f062b252d1d19bca55e721290ee62Mike Lockwood return 1; 287cd185f23cc6f062b252d1d19bca55e721290ee62Mike Lockwood } 288cd185f23cc6f062b252d1d19bca55e721290ee62Mike Lockwood D("usb_device_reopen_writeable failed errno %d\n", errno); 289cd185f23cc6f062b252d1d19bca55e721290ee62Mike Lockwood return 0; 290cd185f23cc6f062b252d1d19bca55e721290ee62Mike Lockwood} 291cd185f23cc6f062b252d1d19bca55e721290ee62Mike Lockwood 292cd185f23cc6f062b252d1d19bca55e721290ee62Mike Lockwoodint usb_device_get_fd(struct usb_device *device) 293cd185f23cc6f062b252d1d19bca55e721290ee62Mike Lockwood{ 294cd185f23cc6f062b252d1d19bca55e721290ee62Mike Lockwood if (!usb_device_reopen_writeable(device)) 295cd185f23cc6f062b252d1d19bca55e721290ee62Mike Lockwood return -1; 296cd185f23cc6f062b252d1d19bca55e721290ee62Mike Lockwood return device->fd; 29730ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood} 29830ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 29930ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwoodconst char* usb_device_get_name(struct usb_device *device) 30030ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood{ 30130ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood return device->dev_name; 30230ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood} 30330ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 304203f102028c4df33c191d8cd610775eba8d5366dMike Lockwoodint usb_device_get_unique_id(struct usb_device *device) 305203f102028c4df33c191d8cd610775eba8d5366dMike Lockwood{ 306203f102028c4df33c191d8cd610775eba8d5366dMike Lockwood int bus = 0, dev = 0; 307203f102028c4df33c191d8cd610775eba8d5366dMike Lockwood sscanf(device->dev_name, USB_FS_ID_SCANNER, &bus, &dev); 308203f102028c4df33c191d8cd610775eba8d5366dMike Lockwood return bus * 1000 + dev; 309203f102028c4df33c191d8cd610775eba8d5366dMike Lockwood} 310203f102028c4df33c191d8cd610775eba8d5366dMike Lockwood 31107eb4af174f31c449a86dd459e2c81702f74acf1Mike Lockwoodint usb_device_get_unique_id_from_name(const char* name) 31207eb4af174f31c449a86dd459e2c81702f74acf1Mike Lockwood{ 31307eb4af174f31c449a86dd459e2c81702f74acf1Mike Lockwood int bus = 0, dev = 0; 31407eb4af174f31c449a86dd459e2c81702f74acf1Mike Lockwood sscanf(name, USB_FS_ID_SCANNER, &bus, &dev); 31507eb4af174f31c449a86dd459e2c81702f74acf1Mike Lockwood return bus * 1000 + dev; 31607eb4af174f31c449a86dd459e2c81702f74acf1Mike Lockwood} 31707eb4af174f31c449a86dd459e2c81702f74acf1Mike Lockwood 3187d700f8bdce747a26e3ee4737683194d77286ba3Mike Lockwoodchar* usb_device_get_name_from_unique_id(int id) 3197d700f8bdce747a26e3ee4737683194d77286ba3Mike Lockwood{ 3207d700f8bdce747a26e3ee4737683194d77286ba3Mike Lockwood int bus = id / 1000; 3217d700f8bdce747a26e3ee4737683194d77286ba3Mike Lockwood int dev = id % 1000; 3227d700f8bdce747a26e3ee4737683194d77286ba3Mike Lockwood char* result = (char *)calloc(1, strlen(USB_FS_ID_FORMAT)); 3237d700f8bdce747a26e3ee4737683194d77286ba3Mike Lockwood snprintf(result, strlen(USB_FS_ID_FORMAT) - 1, USB_FS_ID_FORMAT, bus, dev); 3247d700f8bdce747a26e3ee4737683194d77286ba3Mike Lockwood return result; 3257d700f8bdce747a26e3ee4737683194d77286ba3Mike Lockwood} 3267d700f8bdce747a26e3ee4737683194d77286ba3Mike Lockwood 32730ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwooduint16_t usb_device_get_vendor_id(struct usb_device *device) 32830ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood{ 32930ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood struct usb_device_descriptor* desc = (struct usb_device_descriptor*)device->desc; 33030ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood return __le16_to_cpu(desc->idVendor); 33130ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood} 33230ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 33330ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwooduint16_t usb_device_get_product_id(struct usb_device *device) 33430ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood{ 33530ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood struct usb_device_descriptor* desc = (struct usb_device_descriptor*)device->desc; 33630ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood return __le16_to_cpu(desc->idProduct); 33730ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood} 33830ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 33950372073d2919480fb32d56cb3b91663b9fca0f1Mike Lockwoodconst struct usb_device_descriptor* usb_device_get_device_descriptor(struct usb_device *device) 34050372073d2919480fb32d56cb3b91663b9fca0f1Mike Lockwood{ 34150372073d2919480fb32d56cb3b91663b9fca0f1Mike Lockwood return (struct usb_device_descriptor*)device->desc; 34250372073d2919480fb32d56cb3b91663b9fca0f1Mike Lockwood} 34350372073d2919480fb32d56cb3b91663b9fca0f1Mike Lockwood 3441b7d991b433cf6d6fae4f40cb37f9b6c6043cfbcMike Lockwoodint usb_device_send_control(struct usb_device *device, 3451b7d991b433cf6d6fae4f40cb37f9b6c6043cfbcMike Lockwood int requestType, 3461b7d991b433cf6d6fae4f40cb37f9b6c6043cfbcMike Lockwood int request, 3471b7d991b433cf6d6fae4f40cb37f9b6c6043cfbcMike Lockwood int value, 3481b7d991b433cf6d6fae4f40cb37f9b6c6043cfbcMike Lockwood int index, 3491b7d991b433cf6d6fae4f40cb37f9b6c6043cfbcMike Lockwood int length, 3501b7d991b433cf6d6fae4f40cb37f9b6c6043cfbcMike Lockwood void* buffer) 35130ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood{ 35230ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood struct usbdevfs_ctrltransfer ctrl; 35330ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 3541b7d991b433cf6d6fae4f40cb37f9b6c6043cfbcMike Lockwood // this usually requires read/write permission 355cd185f23cc6f062b252d1d19bca55e721290ee62Mike Lockwood if (!usb_device_reopen_writeable(device)) 356cd185f23cc6f062b252d1d19bca55e721290ee62Mike Lockwood return -1; 35730ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 35830ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood memset(&ctrl, 0, sizeof(ctrl)); 3591b7d991b433cf6d6fae4f40cb37f9b6c6043cfbcMike Lockwood ctrl.bRequestType = requestType; 3601b7d991b433cf6d6fae4f40cb37f9b6c6043cfbcMike Lockwood ctrl.bRequest = request; 3611b7d991b433cf6d6fae4f40cb37f9b6c6043cfbcMike Lockwood ctrl.wValue = value; 3621b7d991b433cf6d6fae4f40cb37f9b6c6043cfbcMike Lockwood ctrl.wIndex = index; 3631b7d991b433cf6d6fae4f40cb37f9b6c6043cfbcMike Lockwood ctrl.wLength = length; 3641b7d991b433cf6d6fae4f40cb37f9b6c6043cfbcMike Lockwood ctrl.data = buffer; 3651b7d991b433cf6d6fae4f40cb37f9b6c6043cfbcMike Lockwood return ioctl(device->fd, USBDEVFS_CONTROL, &ctrl); 3661b7d991b433cf6d6fae4f40cb37f9b6c6043cfbcMike Lockwood} 3671b7d991b433cf6d6fae4f40cb37f9b6c6043cfbcMike Lockwood 3681b7d991b433cf6d6fae4f40cb37f9b6c6043cfbcMike Lockwoodchar* usb_device_get_string(struct usb_device *device, int id) 3691b7d991b433cf6d6fae4f40cb37f9b6c6043cfbcMike Lockwood{ 3701b7d991b433cf6d6fae4f40cb37f9b6c6043cfbcMike Lockwood char string[256]; 3711b7d991b433cf6d6fae4f40cb37f9b6c6043cfbcMike Lockwood __u16 buffer[128]; 3721b7d991b433cf6d6fae4f40cb37f9b6c6043cfbcMike Lockwood __u16 languages[128]; 3731b7d991b433cf6d6fae4f40cb37f9b6c6043cfbcMike Lockwood int i, result; 3741b7d991b433cf6d6fae4f40cb37f9b6c6043cfbcMike Lockwood int languageCount = 0; 3751b7d991b433cf6d6fae4f40cb37f9b6c6043cfbcMike Lockwood 3761b7d991b433cf6d6fae4f40cb37f9b6c6043cfbcMike Lockwood string[0] = 0; 3771b7d991b433cf6d6fae4f40cb37f9b6c6043cfbcMike Lockwood memset(languages, 0, sizeof(languages)); 37830ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 37930ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood // read list of supported languages 3801b7d991b433cf6d6fae4f40cb37f9b6c6043cfbcMike Lockwood result = usb_device_send_control(device, 3811b7d991b433cf6d6fae4f40cb37f9b6c6043cfbcMike Lockwood USB_DIR_IN|USB_TYPE_STANDARD|USB_RECIP_DEVICE, USB_REQ_GET_DESCRIPTOR, 3821b7d991b433cf6d6fae4f40cb37f9b6c6043cfbcMike Lockwood (USB_DT_STRING << 8) | 0, 0, sizeof(languages), languages); 38330ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood if (result > 0) 38430ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood languageCount = (result - 2) / 2; 38530ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 38630ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood for (i = 1; i <= languageCount; i++) { 38730ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood memset(buffer, 0, sizeof(buffer)); 38830ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 3891b7d991b433cf6d6fae4f40cb37f9b6c6043cfbcMike Lockwood result = usb_device_send_control(device, 3901b7d991b433cf6d6fae4f40cb37f9b6c6043cfbcMike Lockwood USB_DIR_IN|USB_TYPE_STANDARD|USB_RECIP_DEVICE, USB_REQ_GET_DESCRIPTOR, 3911b7d991b433cf6d6fae4f40cb37f9b6c6043cfbcMike Lockwood (USB_DT_STRING << 8) | id, languages[i], sizeof(buffer), buffer); 39230ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood if (result > 0) { 39330ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood int i; 39430ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood // skip first word, and copy the rest to the string, changing shorts to bytes. 39530ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood result /= 2; 39630ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood for (i = 1; i < result; i++) 39730ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood string[i - 1] = buffer[i]; 39830ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood string[i - 1] = 0; 39930ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood return strdup(string); 40030ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood } 40130ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood } 40230ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 40330ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood return NULL; 40430ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood} 40530ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 40630ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwoodchar* usb_device_get_manufacturer_name(struct usb_device *device) 40730ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood{ 40830ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood struct usb_device_descriptor *desc = (struct usb_device_descriptor *)device->desc; 40930ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 41030ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood if (desc->iManufacturer) 41130ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood return usb_device_get_string(device, desc->iManufacturer); 41230ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood else 41330ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood return NULL; 41430ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood} 41530ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 41630ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwoodchar* usb_device_get_product_name(struct usb_device *device) 41730ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood{ 41830ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood struct usb_device_descriptor *desc = (struct usb_device_descriptor *)device->desc; 41930ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 42030ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood if (desc->iProduct) 42130ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood return usb_device_get_string(device, desc->iProduct); 42230ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood else 42330ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood return NULL; 42430ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood} 42530ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 42630ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwoodchar* usb_device_get_serial(struct usb_device *device) 42730ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood{ 42830ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood struct usb_device_descriptor *desc = (struct usb_device_descriptor *)device->desc; 42930ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 43030ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood if (desc->iSerialNumber) 43130ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood return usb_device_get_string(device, desc->iSerialNumber); 43230ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood else 43330ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood return NULL; 43430ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood} 43530ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 43630ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwoodint usb_device_is_writeable(struct usb_device *device) 43730ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood{ 43830ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood return device->writeable; 43930ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood} 44030ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 44130ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwoodvoid usb_descriptor_iter_init(struct usb_device *device, struct usb_descriptor_iter *iter) 44230ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood{ 44330ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood iter->config = device->desc; 44430ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood iter->config_end = device->desc + device->desc_length; 44530ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood iter->curr_desc = device->desc; 44630ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood} 44730ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 44830ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwoodstruct usb_descriptor_header *usb_descriptor_iter_next(struct usb_descriptor_iter *iter) 44930ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood{ 45030ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood struct usb_descriptor_header* next; 45130ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood if (iter->curr_desc >= iter->config_end) 45230ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood return NULL; 45330ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood next = (struct usb_descriptor_header*)iter->curr_desc; 45430ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood iter->curr_desc += next->bLength; 45530ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood return next; 45630ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood} 45730ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 45830ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwoodint usb_device_claim_interface(struct usb_device *device, unsigned int interface) 45930ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood{ 46030ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood return ioctl(device->fd, USBDEVFS_CLAIMINTERFACE, &interface); 46130ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood} 46230ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 46330ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwoodint usb_device_release_interface(struct usb_device *device, unsigned int interface) 46430ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood{ 46530ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood return ioctl(device->fd, USBDEVFS_RELEASEINTERFACE, &interface); 46630ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood} 46730ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 46830ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwoodstruct usb_endpoint *usb_endpoint_open(struct usb_device *dev, 46930ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood const struct usb_endpoint_descriptor *desc) 47030ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood{ 47130ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood struct usb_endpoint *ep = calloc(1, sizeof(struct usb_endpoint)); 47230ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood memcpy(&ep->desc, desc, sizeof(ep->desc)); 47330ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood ep->dev = dev; 47430ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood return ep; 47530ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood} 47630ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 47730ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwoodvoid usb_endpoint_close(struct usb_endpoint *ep) 47830ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood{ 47930ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood // cancel IO here? 48030ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood free(ep); 48130ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood} 48230ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 48330ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwoodint usb_endpoint_queue(struct usb_endpoint *ep, void *data, int len) 48430ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood{ 48530ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood struct usbdevfs_urb *urb = &ep->urb; 48630ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood int res; 48730ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 48830ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood D("usb_endpoint_queue\n"); 48930ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood memset(urb, 0, sizeof(*urb)); 49030ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood urb->type = USBDEVFS_URB_TYPE_BULK; 49130ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood urb->endpoint = ep->desc.bEndpointAddress; 49230ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood urb->status = -1; 49330ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood urb->buffer = data; 49430ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood urb->buffer_length = len; 49530ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 49630ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood do { 49730ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood res = ioctl(ep->dev->fd, USBDEVFS_SUBMITURB, urb); 49830ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood } while((res < 0) && (errno == EINTR)); 49930ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 50030ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood return res; 50130ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood} 50230ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 50330ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwoodint usb_endpoint_wait(struct usb_device *dev, int *out_ep_num) 50430ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood{ 50530ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood struct usbdevfs_urb *out = NULL; 50630ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood int res; 50730ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 50830ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood while (1) { 50930ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood res = ioctl(dev->fd, USBDEVFS_REAPURB, &out); 51030ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood D("USBDEVFS_REAPURB returned %d\n", res); 51130ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood if (res < 0) { 51230ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood if(errno == EINTR) { 51330ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood continue; 51430ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood } 51530ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood D("[ reap urb - error ]\n"); 51630ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood *out_ep_num = -1; 51730ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood } else { 51830ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood D("[ urb @%p status = %d, actual = %d ]\n", 51930ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood out, out->status, out->actual_length); 52030ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood res = out->actual_length; 52130ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood *out_ep_num = out->endpoint; 52230ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood } 52330ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood break; 52430ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood } 52530ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood return res; 52630ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood} 52730ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 52830ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwoodint usb_endpoint_cancel(struct usb_endpoint *ep) 52930ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood{ 53030ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood return ioctl(ep->dev->fd, USBDEVFS_DISCARDURB, &ep->urb); 53130ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood} 53230ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 5335e567cb34b5e54467f501fc9703db82ca6639ff3Mike Lockwoodstruct usb_device *usb_endpoint_get_device(struct usb_endpoint *ep) 5345e567cb34b5e54467f501fc9703db82ca6639ff3Mike Lockwood{ 5355e567cb34b5e54467f501fc9703db82ca6639ff3Mike Lockwood return ep->dev; 5365e567cb34b5e54467f501fc9703db82ca6639ff3Mike Lockwood} 5375e567cb34b5e54467f501fc9703db82ca6639ff3Mike Lockwood 53830ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwoodint usb_endpoint_number(struct usb_endpoint *ep) 53930ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood{ 54030ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood return ep->desc.bEndpointAddress; 54130ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood} 54230ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 54330ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwoodint usb_endpoint_max_packet(struct usb_endpoint *ep) 54430ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood{ 54530ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood return __le16_to_cpu(ep->desc.wMaxPacketSize); 54630ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood} 54730ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 548