usbhost.c revision 6cc883ca098f34bd126478a6aa19d5cce48d71a9
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" 238d66c49258ac4f59bd67c23c9c914cca81f85b01Steve Block#define D ALOGD 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 <asm/byteorder.h> 4930ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 5030ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood#include "usbhost/usbhost.h" 5130ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 5230ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood#define USB_FS_DIR "/dev/bus/usb" 53203f102028c4df33c191d8cd610775eba8d5366dMike Lockwood#define USB_FS_ID_SCANNER "/dev/bus/usb/%d/%d" 547d700f8bdce747a26e3ee4737683194d77286ba3Mike Lockwood#define USB_FS_ID_FORMAT "/dev/bus/usb/%03d/%03d" 5530ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 56c4c00d8e6a215020be87f6702844267e105e1f0eMike Lockwood// From drivers/usb/core/devio.c 57c4c00d8e6a215020be87f6702844267e105e1f0eMike Lockwood// I don't know why this isn't in a kernel header 58c4c00d8e6a215020be87f6702844267e105e1f0eMike Lockwood#define MAX_USBFS_BUFFER_SIZE 16384 5930ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 606ac3aa157493ef24bc837b679dd8292fad8961e0Mike Lockwoodstruct usb_host_context { 617a96ba436c9a2bacc64e712bdb53bd7accc5c3a9Mike Lockwood int fd; 626ac3aa157493ef24bc837b679dd8292fad8961e0Mike Lockwood}; 636ac3aa157493ef24bc837b679dd8292fad8961e0Mike Lockwood 6430ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwoodstruct usb_device { 6530ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood char dev_name[64]; 66ec9e7b1c1844e66c39a4f63ded8208c1717380f8Mike Lockwood unsigned char desc[4096]; 6730ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood int desc_length; 6830ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood int fd; 6930ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood int writeable; 7030ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood}; 7130ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 7230ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwoodstatic inline int badname(const char *name) 7330ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood{ 7430ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood while(*name) { 7530ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood if(!isdigit(*name++)) return 1; 7630ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood } 7730ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood return 0; 7830ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood} 7930ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 806cc883ca098f34bd126478a6aa19d5cce48d71a9Benoit Gobystatic int find_existing_devices_bus(char *busname, 816cc883ca098f34bd126478a6aa19d5cce48d71a9Benoit Goby usb_device_added_cb added_cb, 826cc883ca098f34bd126478a6aa19d5cce48d71a9Benoit Goby void *client_data) 836cc883ca098f34bd126478a6aa19d5cce48d71a9Benoit Goby{ 846cc883ca098f34bd126478a6aa19d5cce48d71a9Benoit Goby char devname[32]; 856cc883ca098f34bd126478a6aa19d5cce48d71a9Benoit Goby DIR *devdir; 866cc883ca098f34bd126478a6aa19d5cce48d71a9Benoit Goby struct dirent *de; 876cc883ca098f34bd126478a6aa19d5cce48d71a9Benoit Goby int done = 0; 886cc883ca098f34bd126478a6aa19d5cce48d71a9Benoit Goby 896cc883ca098f34bd126478a6aa19d5cce48d71a9Benoit Goby devdir = opendir(busname); 906cc883ca098f34bd126478a6aa19d5cce48d71a9Benoit Goby if(devdir == 0) return 0; 916cc883ca098f34bd126478a6aa19d5cce48d71a9Benoit Goby 926cc883ca098f34bd126478a6aa19d5cce48d71a9Benoit Goby while ((de = readdir(devdir)) && !done) { 936cc883ca098f34bd126478a6aa19d5cce48d71a9Benoit Goby if(badname(de->d_name)) continue; 946cc883ca098f34bd126478a6aa19d5cce48d71a9Benoit Goby 956cc883ca098f34bd126478a6aa19d5cce48d71a9Benoit Goby snprintf(devname, sizeof(devname), "%s/%s", busname, de->d_name); 966cc883ca098f34bd126478a6aa19d5cce48d71a9Benoit Goby done = added_cb(devname, client_data); 976cc883ca098f34bd126478a6aa19d5cce48d71a9Benoit Goby } // end of devdir while 986cc883ca098f34bd126478a6aa19d5cce48d71a9Benoit Goby closedir(devdir); 996cc883ca098f34bd126478a6aa19d5cce48d71a9Benoit Goby 1006cc883ca098f34bd126478a6aa19d5cce48d71a9Benoit Goby return done; 1016cc883ca098f34bd126478a6aa19d5cce48d71a9Benoit Goby} 1026cc883ca098f34bd126478a6aa19d5cce48d71a9Benoit Goby 1037a96ba436c9a2bacc64e712bdb53bd7accc5c3a9Mike Lockwood/* returns true if one of the callbacks indicates we are done */ 1047a96ba436c9a2bacc64e712bdb53bd7accc5c3a9Mike Lockwoodstatic int find_existing_devices(usb_device_added_cb added_cb, 1057a96ba436c9a2bacc64e712bdb53bd7accc5c3a9Mike Lockwood void *client_data) 10630ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood{ 1076cc883ca098f34bd126478a6aa19d5cce48d71a9Benoit Goby char busname[32]; 1086cc883ca098f34bd126478a6aa19d5cce48d71a9Benoit Goby DIR *busdir; 10930ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood struct dirent *de; 1107a96ba436c9a2bacc64e712bdb53bd7accc5c3a9Mike Lockwood int done = 0; 11130ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 11230ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood busdir = opendir(USB_FS_DIR); 1137a96ba436c9a2bacc64e712bdb53bd7accc5c3a9Mike Lockwood if(busdir == 0) return 1; 11430ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 1157a96ba436c9a2bacc64e712bdb53bd7accc5c3a9Mike Lockwood while ((de = readdir(busdir)) != 0 && !done) { 11630ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood if(badname(de->d_name)) continue; 11730ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 1186cc883ca098f34bd126478a6aa19d5cce48d71a9Benoit Goby snprintf(busname, sizeof(busname), "%s/%s", USB_FS_DIR, de->d_name); 1196cc883ca098f34bd126478a6aa19d5cce48d71a9Benoit Goby done = find_existing_devices_bus(busname, added_cb, 1206cc883ca098f34bd126478a6aa19d5cce48d71a9Benoit Goby client_data); 1216cc883ca098f34bd126478a6aa19d5cce48d71a9Benoit Goby } 12230ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood closedir(busdir); 1237a96ba436c9a2bacc64e712bdb53bd7accc5c3a9Mike Lockwood 1247a96ba436c9a2bacc64e712bdb53bd7accc5c3a9Mike Lockwood return done; 1257a96ba436c9a2bacc64e712bdb53bd7accc5c3a9Mike Lockwood} 1267a96ba436c9a2bacc64e712bdb53bd7accc5c3a9Mike Lockwood 1277a96ba436c9a2bacc64e712bdb53bd7accc5c3a9Mike Lockwoodstruct usb_host_context *usb_host_init() 1287a96ba436c9a2bacc64e712bdb53bd7accc5c3a9Mike Lockwood{ 1297a96ba436c9a2bacc64e712bdb53bd7accc5c3a9Mike Lockwood struct usb_host_context *context = calloc(1, sizeof(struct usb_host_context)); 1307a96ba436c9a2bacc64e712bdb53bd7accc5c3a9Mike Lockwood if (!context) { 1317a96ba436c9a2bacc64e712bdb53bd7accc5c3a9Mike Lockwood fprintf(stderr, "out of memory in usb_host_context\n"); 1327a96ba436c9a2bacc64e712bdb53bd7accc5c3a9Mike Lockwood return NULL; 1337a96ba436c9a2bacc64e712bdb53bd7accc5c3a9Mike Lockwood } 1347a96ba436c9a2bacc64e712bdb53bd7accc5c3a9Mike Lockwood context->fd = inotify_init(); 1357a96ba436c9a2bacc64e712bdb53bd7accc5c3a9Mike Lockwood if (context->fd < 0) { 1367a96ba436c9a2bacc64e712bdb53bd7accc5c3a9Mike Lockwood fprintf(stderr, "inotify_init failed\n"); 1377a96ba436c9a2bacc64e712bdb53bd7accc5c3a9Mike Lockwood free(context); 1387a96ba436c9a2bacc64e712bdb53bd7accc5c3a9Mike Lockwood return NULL; 1397a96ba436c9a2bacc64e712bdb53bd7accc5c3a9Mike Lockwood } 1407a96ba436c9a2bacc64e712bdb53bd7accc5c3a9Mike Lockwood return context; 1417a96ba436c9a2bacc64e712bdb53bd7accc5c3a9Mike Lockwood} 1427a96ba436c9a2bacc64e712bdb53bd7accc5c3a9Mike Lockwood 1437a96ba436c9a2bacc64e712bdb53bd7accc5c3a9Mike Lockwoodvoid usb_host_cleanup(struct usb_host_context *context) 1447a96ba436c9a2bacc64e712bdb53bd7accc5c3a9Mike Lockwood{ 1457a96ba436c9a2bacc64e712bdb53bd7accc5c3a9Mike Lockwood close(context->fd); 1467a96ba436c9a2bacc64e712bdb53bd7accc5c3a9Mike Lockwood free(context); 14730ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood} 14830ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 1497a96ba436c9a2bacc64e712bdb53bd7accc5c3a9Mike Lockwoodvoid usb_host_run(struct usb_host_context *context, 1507a96ba436c9a2bacc64e712bdb53bd7accc5c3a9Mike Lockwood usb_device_added_cb added_cb, 1517a96ba436c9a2bacc64e712bdb53bd7accc5c3a9Mike Lockwood usb_device_removed_cb removed_cb, 152a805519ceedc53afa5453a6d8a7d80038d885d9fMike Lockwood usb_discovery_done_cb discovery_done_cb, 1537a96ba436c9a2bacc64e712bdb53bd7accc5c3a9Mike Lockwood void *client_data) 15430ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood{ 15530ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood struct inotify_event* event; 15630ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood char event_buf[512]; 15730ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood char path[100]; 1587a96ba436c9a2bacc64e712bdb53bd7accc5c3a9Mike Lockwood int i, ret, done = 0; 15930ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood int wd, wds[10]; 16030ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood int wd_count = sizeof(wds) / sizeof(wds[0]); 16130ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 16230ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood D("Created device discovery thread\n"); 16330ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 16430ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood /* watch for files added and deleted within USB_FS_DIR */ 16530ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood memset(wds, 0, sizeof(wds)); 16630ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood /* watch the root for new subdirectories */ 1677a96ba436c9a2bacc64e712bdb53bd7accc5c3a9Mike Lockwood wds[0] = inotify_add_watch(context->fd, USB_FS_DIR, IN_CREATE | IN_DELETE); 16830ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood if (wds[0] < 0) { 16930ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood fprintf(stderr, "inotify_add_watch failed\n"); 170e8849d190a3097274dcb64416e564538a1017054Mike Lockwood if (discovery_done_cb) 171e8849d190a3097274dcb64416e564538a1017054Mike Lockwood discovery_done_cb(client_data); 1727a96ba436c9a2bacc64e712bdb53bd7accc5c3a9Mike Lockwood return; 17330ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood } 17430ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 17530ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood /* watch existing subdirectories of USB_FS_DIR */ 17630ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood for (i = 1; i < wd_count; i++) { 17730ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood snprintf(path, sizeof(path), "%s/%03d", USB_FS_DIR, i); 1787a96ba436c9a2bacc64e712bdb53bd7accc5c3a9Mike Lockwood ret = inotify_add_watch(context->fd, path, IN_CREATE | IN_DELETE); 17930ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood if (ret > 0) 18030ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood wds[i] = ret; 18130ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood } 18230ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 18330ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood /* check for existing devices first, after we have inotify set up */ 1846cc883ca098f34bd126478a6aa19d5cce48d71a9Benoit Goby done = find_existing_devices(added_cb, client_data); 185a805519ceedc53afa5453a6d8a7d80038d885d9fMike Lockwood if (discovery_done_cb) 186a805519ceedc53afa5453a6d8a7d80038d885d9fMike Lockwood done |= discovery_done_cb(client_data); 18730ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 1887a96ba436c9a2bacc64e712bdb53bd7accc5c3a9Mike Lockwood while (!done) { 1897a96ba436c9a2bacc64e712bdb53bd7accc5c3a9Mike Lockwood ret = read(context->fd, event_buf, sizeof(event_buf)); 19030ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood if (ret >= (int)sizeof(struct inotify_event)) { 19130ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood event = (struct inotify_event *)event_buf; 19230ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood wd = event->wd; 19330ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood if (wd == wds[0]) { 19430ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood i = atoi(event->name); 19530ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood snprintf(path, sizeof(path), "%s/%s", USB_FS_DIR, event->name); 1966cc883ca098f34bd126478a6aa19d5cce48d71a9Benoit Goby D("%s subdirectory %s: index: %d\n", (event->mask & IN_CREATE) ? 1976cc883ca098f34bd126478a6aa19d5cce48d71a9Benoit Goby "new" : "gone", path, i); 19830ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood if (i > 0 && i < wd_count) { 1996cc883ca098f34bd126478a6aa19d5cce48d71a9Benoit Goby if (event->mask & IN_CREATE) { 2006cc883ca098f34bd126478a6aa19d5cce48d71a9Benoit Goby ret = inotify_add_watch(context->fd, path, 2016cc883ca098f34bd126478a6aa19d5cce48d71a9Benoit Goby IN_CREATE | IN_DELETE); 2026cc883ca098f34bd126478a6aa19d5cce48d71a9Benoit Goby if (ret > 0) 2036cc883ca098f34bd126478a6aa19d5cce48d71a9Benoit Goby wds[i] = ret; 2046cc883ca098f34bd126478a6aa19d5cce48d71a9Benoit Goby done = find_existing_devices_bus(path, added_cb, 2056cc883ca098f34bd126478a6aa19d5cce48d71a9Benoit Goby client_data); 2066cc883ca098f34bd126478a6aa19d5cce48d71a9Benoit Goby } else if (event->mask & IN_DELETE) { 2076cc883ca098f34bd126478a6aa19d5cce48d71a9Benoit Goby inotify_rm_watch(context->fd, wds[i]); 2086cc883ca098f34bd126478a6aa19d5cce48d71a9Benoit Goby wds[i] = -1; 2096cc883ca098f34bd126478a6aa19d5cce48d71a9Benoit Goby } 21030ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood } 21130ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood } else { 2127a96ba436c9a2bacc64e712bdb53bd7accc5c3a9Mike Lockwood for (i = 1; i < wd_count && !done; i++) { 21330ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood if (wd == wds[i]) { 21430ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood snprintf(path, sizeof(path), "%s/%03d/%s", USB_FS_DIR, i, event->name); 21530ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood if (event->mask == IN_CREATE) { 21630ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood D("new device %s\n", path); 2177a96ba436c9a2bacc64e712bdb53bd7accc5c3a9Mike Lockwood done = added_cb(path, client_data); 21830ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood } else if (event->mask == IN_DELETE) { 21930ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood D("gone device %s\n", path); 2207a96ba436c9a2bacc64e712bdb53bd7accc5c3a9Mike Lockwood done = removed_cb(path, client_data); 22130ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood } 22230ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood } 22330ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood } 22430ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood } 22530ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood } 22630ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood } 22730ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood} 22830ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 22930ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwoodstruct usb_device *usb_device_open(const char *dev_name) 23030ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood{ 231cd185f23cc6f062b252d1d19bca55e721290ee62Mike Lockwood int fd, did_retry = 0, writeable = 1; 23230ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 233ec9e7b1c1844e66c39a4f63ded8208c1717380f8Mike Lockwood D("usb_device_open %s\n", dev_name); 234ec9e7b1c1844e66c39a4f63ded8208c1717380f8Mike Lockwood 23530ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwoodretry: 23630ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood fd = open(dev_name, O_RDWR); 23730ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood if (fd < 0) { 23830ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood /* if we fail, see if have read-only access */ 23930ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood fd = open(dev_name, O_RDONLY); 240e15af09876c5e0301084f46b8036aed147cf9c24Mike Lockwood D("usb_device_open open returned %d errno %d\n", fd, errno); 241e15af09876c5e0301084f46b8036aed147cf9c24Mike Lockwood if (fd < 0 && (errno == EACCES || errno == ENOENT) && !did_retry) { 24230ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood /* work around race condition between inotify and permissions management */ 24330ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood sleep(1); 24430ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood did_retry = 1; 24530ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood goto retry; 24630ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood } 24730ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 248cd185f23cc6f062b252d1d19bca55e721290ee62Mike Lockwood if (fd < 0) 249cd185f23cc6f062b252d1d19bca55e721290ee62Mike Lockwood return NULL; 250cd185f23cc6f062b252d1d19bca55e721290ee62Mike Lockwood writeable = 0; 25130ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood D("[ usb open read-only %s fd = %d]\n", dev_name, fd); 25230ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood } 25330ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 254cd185f23cc6f062b252d1d19bca55e721290ee62Mike Lockwood struct usb_device* result = usb_device_new(dev_name, fd); 255cd185f23cc6f062b252d1d19bca55e721290ee62Mike Lockwood if (result) 256cd185f23cc6f062b252d1d19bca55e721290ee62Mike Lockwood result->writeable = writeable; 257cd185f23cc6f062b252d1d19bca55e721290ee62Mike Lockwood return result; 258cd185f23cc6f062b252d1d19bca55e721290ee62Mike Lockwood} 259cd185f23cc6f062b252d1d19bca55e721290ee62Mike Lockwood 260cd185f23cc6f062b252d1d19bca55e721290ee62Mike Lockwoodvoid usb_device_close(struct usb_device *device) 261cd185f23cc6f062b252d1d19bca55e721290ee62Mike Lockwood{ 262cd185f23cc6f062b252d1d19bca55e721290ee62Mike Lockwood close(device->fd); 263cd185f23cc6f062b252d1d19bca55e721290ee62Mike Lockwood free(device); 264cd185f23cc6f062b252d1d19bca55e721290ee62Mike Lockwood} 265cd185f23cc6f062b252d1d19bca55e721290ee62Mike Lockwood 266cd185f23cc6f062b252d1d19bca55e721290ee62Mike Lockwoodstruct usb_device *usb_device_new(const char *dev_name, int fd) 267cd185f23cc6f062b252d1d19bca55e721290ee62Mike Lockwood{ 268cd185f23cc6f062b252d1d19bca55e721290ee62Mike Lockwood struct usb_device *device = calloc(1, sizeof(struct usb_device)); 269cd185f23cc6f062b252d1d19bca55e721290ee62Mike Lockwood int length; 270cd185f23cc6f062b252d1d19bca55e721290ee62Mike Lockwood 271ec9e7b1c1844e66c39a4f63ded8208c1717380f8Mike Lockwood D("usb_device_new %s fd: %d\n", dev_name, fd); 272ec9e7b1c1844e66c39a4f63ded8208c1717380f8Mike Lockwood 273cd185f23cc6f062b252d1d19bca55e721290ee62Mike Lockwood if (lseek(fd, 0, SEEK_SET) != 0) 274cd185f23cc6f062b252d1d19bca55e721290ee62Mike Lockwood goto failed; 27530ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood length = read(fd, device->desc, sizeof(device->desc)); 276ec9e7b1c1844e66c39a4f63ded8208c1717380f8Mike Lockwood D("usb_device_new read returned %d errno %d\n", length, errno); 27730ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood if (length < 0) 278cd185f23cc6f062b252d1d19bca55e721290ee62Mike Lockwood goto failed; 27930ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 28093aff72d9b469f4b77468bab654cd65243b662e6Mike Lockwood strncpy(device->dev_name, dev_name, sizeof(device->dev_name) - 1); 28130ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood device->fd = fd; 28230ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood device->desc_length = length; 283cd185f23cc6f062b252d1d19bca55e721290ee62Mike Lockwood // assume we are writeable, since usb_device_get_fd will only return writeable fds 284cd185f23cc6f062b252d1d19bca55e721290ee62Mike Lockwood device->writeable = 1; 28530ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood return device; 286cd185f23cc6f062b252d1d19bca55e721290ee62Mike Lockwood 287cd185f23cc6f062b252d1d19bca55e721290ee62Mike Lockwoodfailed: 28830ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood close(fd); 28930ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood free(device); 29030ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood return NULL; 29130ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood} 29230ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 293cd185f23cc6f062b252d1d19bca55e721290ee62Mike Lockwoodstatic int usb_device_reopen_writeable(struct usb_device *device) 29430ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood{ 295cd185f23cc6f062b252d1d19bca55e721290ee62Mike Lockwood if (device->writeable) 296cd185f23cc6f062b252d1d19bca55e721290ee62Mike Lockwood return 1; 297cd185f23cc6f062b252d1d19bca55e721290ee62Mike Lockwood 298cd185f23cc6f062b252d1d19bca55e721290ee62Mike Lockwood int fd = open(device->dev_name, O_RDWR); 299cd185f23cc6f062b252d1d19bca55e721290ee62Mike Lockwood if (fd >= 0) { 300cd185f23cc6f062b252d1d19bca55e721290ee62Mike Lockwood close(device->fd); 301cd185f23cc6f062b252d1d19bca55e721290ee62Mike Lockwood device->fd = fd; 302cd185f23cc6f062b252d1d19bca55e721290ee62Mike Lockwood device->writeable = 1; 303cd185f23cc6f062b252d1d19bca55e721290ee62Mike Lockwood return 1; 304cd185f23cc6f062b252d1d19bca55e721290ee62Mike Lockwood } 305cd185f23cc6f062b252d1d19bca55e721290ee62Mike Lockwood D("usb_device_reopen_writeable failed errno %d\n", errno); 306cd185f23cc6f062b252d1d19bca55e721290ee62Mike Lockwood return 0; 307cd185f23cc6f062b252d1d19bca55e721290ee62Mike Lockwood} 308cd185f23cc6f062b252d1d19bca55e721290ee62Mike Lockwood 309cd185f23cc6f062b252d1d19bca55e721290ee62Mike Lockwoodint usb_device_get_fd(struct usb_device *device) 310cd185f23cc6f062b252d1d19bca55e721290ee62Mike Lockwood{ 311cd185f23cc6f062b252d1d19bca55e721290ee62Mike Lockwood if (!usb_device_reopen_writeable(device)) 312cd185f23cc6f062b252d1d19bca55e721290ee62Mike Lockwood return -1; 313cd185f23cc6f062b252d1d19bca55e721290ee62Mike Lockwood return device->fd; 31430ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood} 31530ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 31630ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwoodconst char* usb_device_get_name(struct usb_device *device) 31730ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood{ 31830ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood return device->dev_name; 31930ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood} 32030ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 321203f102028c4df33c191d8cd610775eba8d5366dMike Lockwoodint usb_device_get_unique_id(struct usb_device *device) 322203f102028c4df33c191d8cd610775eba8d5366dMike Lockwood{ 323203f102028c4df33c191d8cd610775eba8d5366dMike Lockwood int bus = 0, dev = 0; 324203f102028c4df33c191d8cd610775eba8d5366dMike Lockwood sscanf(device->dev_name, USB_FS_ID_SCANNER, &bus, &dev); 325203f102028c4df33c191d8cd610775eba8d5366dMike Lockwood return bus * 1000 + dev; 326203f102028c4df33c191d8cd610775eba8d5366dMike Lockwood} 327203f102028c4df33c191d8cd610775eba8d5366dMike Lockwood 32807eb4af174f31c449a86dd459e2c81702f74acf1Mike Lockwoodint usb_device_get_unique_id_from_name(const char* name) 32907eb4af174f31c449a86dd459e2c81702f74acf1Mike Lockwood{ 33007eb4af174f31c449a86dd459e2c81702f74acf1Mike Lockwood int bus = 0, dev = 0; 33107eb4af174f31c449a86dd459e2c81702f74acf1Mike Lockwood sscanf(name, USB_FS_ID_SCANNER, &bus, &dev); 33207eb4af174f31c449a86dd459e2c81702f74acf1Mike Lockwood return bus * 1000 + dev; 33307eb4af174f31c449a86dd459e2c81702f74acf1Mike Lockwood} 33407eb4af174f31c449a86dd459e2c81702f74acf1Mike Lockwood 3357d700f8bdce747a26e3ee4737683194d77286ba3Mike Lockwoodchar* usb_device_get_name_from_unique_id(int id) 3367d700f8bdce747a26e3ee4737683194d77286ba3Mike Lockwood{ 3377d700f8bdce747a26e3ee4737683194d77286ba3Mike Lockwood int bus = id / 1000; 3387d700f8bdce747a26e3ee4737683194d77286ba3Mike Lockwood int dev = id % 1000; 3397d700f8bdce747a26e3ee4737683194d77286ba3Mike Lockwood char* result = (char *)calloc(1, strlen(USB_FS_ID_FORMAT)); 3407d700f8bdce747a26e3ee4737683194d77286ba3Mike Lockwood snprintf(result, strlen(USB_FS_ID_FORMAT) - 1, USB_FS_ID_FORMAT, bus, dev); 3417d700f8bdce747a26e3ee4737683194d77286ba3Mike Lockwood return result; 3427d700f8bdce747a26e3ee4737683194d77286ba3Mike Lockwood} 3437d700f8bdce747a26e3ee4737683194d77286ba3Mike Lockwood 34430ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwooduint16_t usb_device_get_vendor_id(struct usb_device *device) 34530ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood{ 34630ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood struct usb_device_descriptor* desc = (struct usb_device_descriptor*)device->desc; 34730ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood return __le16_to_cpu(desc->idVendor); 34830ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood} 34930ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 35030ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwooduint16_t usb_device_get_product_id(struct usb_device *device) 35130ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood{ 35230ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood struct usb_device_descriptor* desc = (struct usb_device_descriptor*)device->desc; 35330ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood return __le16_to_cpu(desc->idProduct); 35430ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood} 35530ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 35650372073d2919480fb32d56cb3b91663b9fca0f1Mike Lockwoodconst struct usb_device_descriptor* usb_device_get_device_descriptor(struct usb_device *device) 35750372073d2919480fb32d56cb3b91663b9fca0f1Mike Lockwood{ 35850372073d2919480fb32d56cb3b91663b9fca0f1Mike Lockwood return (struct usb_device_descriptor*)device->desc; 35950372073d2919480fb32d56cb3b91663b9fca0f1Mike Lockwood} 36050372073d2919480fb32d56cb3b91663b9fca0f1Mike Lockwood 3611b7d991b433cf6d6fae4f40cb37f9b6c6043cfbcMike Lockwoodchar* usb_device_get_string(struct usb_device *device, int id) 3621b7d991b433cf6d6fae4f40cb37f9b6c6043cfbcMike Lockwood{ 3631b7d991b433cf6d6fae4f40cb37f9b6c6043cfbcMike Lockwood char string[256]; 3641b7d991b433cf6d6fae4f40cb37f9b6c6043cfbcMike Lockwood __u16 buffer[128]; 3651b7d991b433cf6d6fae4f40cb37f9b6c6043cfbcMike Lockwood __u16 languages[128]; 3661b7d991b433cf6d6fae4f40cb37f9b6c6043cfbcMike Lockwood int i, result; 3671b7d991b433cf6d6fae4f40cb37f9b6c6043cfbcMike Lockwood int languageCount = 0; 3681b7d991b433cf6d6fae4f40cb37f9b6c6043cfbcMike Lockwood 3691b7d991b433cf6d6fae4f40cb37f9b6c6043cfbcMike Lockwood string[0] = 0; 3701b7d991b433cf6d6fae4f40cb37f9b6c6043cfbcMike Lockwood memset(languages, 0, sizeof(languages)); 37130ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 37230ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood // read list of supported languages 373120b57a3d9703bccba534af335aa94dd3a41be2fMike Lockwood result = usb_device_control_transfer(device, 3741b7d991b433cf6d6fae4f40cb37f9b6c6043cfbcMike Lockwood USB_DIR_IN|USB_TYPE_STANDARD|USB_RECIP_DEVICE, USB_REQ_GET_DESCRIPTOR, 375120b57a3d9703bccba534af335aa94dd3a41be2fMike Lockwood (USB_DT_STRING << 8) | 0, 0, languages, sizeof(languages), 0); 37630ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood if (result > 0) 37730ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood languageCount = (result - 2) / 2; 37830ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 37930ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood for (i = 1; i <= languageCount; i++) { 38030ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood memset(buffer, 0, sizeof(buffer)); 38130ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 382120b57a3d9703bccba534af335aa94dd3a41be2fMike Lockwood result = usb_device_control_transfer(device, 3831b7d991b433cf6d6fae4f40cb37f9b6c6043cfbcMike Lockwood USB_DIR_IN|USB_TYPE_STANDARD|USB_RECIP_DEVICE, USB_REQ_GET_DESCRIPTOR, 384120b57a3d9703bccba534af335aa94dd3a41be2fMike Lockwood (USB_DT_STRING << 8) | id, languages[i], buffer, sizeof(buffer), 0); 38530ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood if (result > 0) { 38630ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood int i; 38730ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood // skip first word, and copy the rest to the string, changing shorts to bytes. 38830ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood result /= 2; 38930ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood for (i = 1; i < result; i++) 39030ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood string[i - 1] = buffer[i]; 39130ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood string[i - 1] = 0; 39230ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood return strdup(string); 39330ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood } 39430ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood } 39530ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 39630ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood return NULL; 39730ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood} 39830ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 39930ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwoodchar* usb_device_get_manufacturer_name(struct usb_device *device) 40030ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood{ 40130ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood struct usb_device_descriptor *desc = (struct usb_device_descriptor *)device->desc; 40230ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 40330ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood if (desc->iManufacturer) 40430ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood return usb_device_get_string(device, desc->iManufacturer); 40530ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood else 40630ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood return NULL; 40730ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood} 40830ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 40930ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwoodchar* usb_device_get_product_name(struct usb_device *device) 41030ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood{ 41130ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood struct usb_device_descriptor *desc = (struct usb_device_descriptor *)device->desc; 41230ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 41330ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood if (desc->iProduct) 41430ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood return usb_device_get_string(device, desc->iProduct); 41530ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood else 41630ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood return NULL; 41730ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood} 41830ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 41930ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwoodchar* usb_device_get_serial(struct usb_device *device) 42030ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood{ 42130ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood struct usb_device_descriptor *desc = (struct usb_device_descriptor *)device->desc; 42230ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 42330ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood if (desc->iSerialNumber) 42430ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood return usb_device_get_string(device, desc->iSerialNumber); 42530ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood else 42630ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood return NULL; 42730ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood} 42830ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 42930ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwoodint usb_device_is_writeable(struct usb_device *device) 43030ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood{ 43130ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood return device->writeable; 43230ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood} 43330ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 43430ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwoodvoid usb_descriptor_iter_init(struct usb_device *device, struct usb_descriptor_iter *iter) 43530ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood{ 43630ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood iter->config = device->desc; 43730ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood iter->config_end = device->desc + device->desc_length; 43830ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood iter->curr_desc = device->desc; 43930ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood} 44030ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 44130ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwoodstruct usb_descriptor_header *usb_descriptor_iter_next(struct usb_descriptor_iter *iter) 44230ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood{ 44330ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood struct usb_descriptor_header* next; 44430ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood if (iter->curr_desc >= iter->config_end) 44530ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood return NULL; 44630ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood next = (struct usb_descriptor_header*)iter->curr_desc; 44730ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood iter->curr_desc += next->bLength; 44830ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood return next; 44930ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood} 45030ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 45130ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwoodint usb_device_claim_interface(struct usb_device *device, unsigned int interface) 45230ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood{ 45330ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood return ioctl(device->fd, USBDEVFS_CLAIMINTERFACE, &interface); 45430ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood} 45530ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 45630ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwoodint usb_device_release_interface(struct usb_device *device, unsigned int interface) 45730ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood{ 45830ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood return ioctl(device->fd, USBDEVFS_RELEASEINTERFACE, &interface); 45930ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood} 46030ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 461ec9e7b1c1844e66c39a4f63ded8208c1717380f8Mike Lockwoodint usb_device_connect_kernel_driver(struct usb_device *device, 462ec9e7b1c1844e66c39a4f63ded8208c1717380f8Mike Lockwood unsigned int interface, int connect) 463ec9e7b1c1844e66c39a4f63ded8208c1717380f8Mike Lockwood{ 464ec9e7b1c1844e66c39a4f63ded8208c1717380f8Mike Lockwood struct usbdevfs_ioctl ctl; 465ec9e7b1c1844e66c39a4f63ded8208c1717380f8Mike Lockwood 466ec9e7b1c1844e66c39a4f63ded8208c1717380f8Mike Lockwood ctl.ifno = interface; 467ec9e7b1c1844e66c39a4f63ded8208c1717380f8Mike Lockwood ctl.ioctl_code = (connect ? USBDEVFS_CONNECT : USBDEVFS_DISCONNECT); 468ec9e7b1c1844e66c39a4f63ded8208c1717380f8Mike Lockwood ctl.data = NULL; 469ec9e7b1c1844e66c39a4f63ded8208c1717380f8Mike Lockwood return ioctl(device->fd, USBDEVFS_IOCTL, &ctl); 470ec9e7b1c1844e66c39a4f63ded8208c1717380f8Mike Lockwood} 471ec9e7b1c1844e66c39a4f63ded8208c1717380f8Mike Lockwood 472120b57a3d9703bccba534af335aa94dd3a41be2fMike Lockwoodint usb_device_control_transfer(struct usb_device *device, 473120b57a3d9703bccba534af335aa94dd3a41be2fMike Lockwood int requestType, 474120b57a3d9703bccba534af335aa94dd3a41be2fMike Lockwood int request, 475120b57a3d9703bccba534af335aa94dd3a41be2fMike Lockwood int value, 476120b57a3d9703bccba534af335aa94dd3a41be2fMike Lockwood int index, 477120b57a3d9703bccba534af335aa94dd3a41be2fMike Lockwood void* buffer, 478120b57a3d9703bccba534af335aa94dd3a41be2fMike Lockwood int length, 479120b57a3d9703bccba534af335aa94dd3a41be2fMike Lockwood unsigned int timeout) 480120b57a3d9703bccba534af335aa94dd3a41be2fMike Lockwood{ 481120b57a3d9703bccba534af335aa94dd3a41be2fMike Lockwood struct usbdevfs_ctrltransfer ctrl; 482120b57a3d9703bccba534af335aa94dd3a41be2fMike Lockwood 483120b57a3d9703bccba534af335aa94dd3a41be2fMike Lockwood // this usually requires read/write permission 484120b57a3d9703bccba534af335aa94dd3a41be2fMike Lockwood if (!usb_device_reopen_writeable(device)) 485120b57a3d9703bccba534af335aa94dd3a41be2fMike Lockwood return -1; 486120b57a3d9703bccba534af335aa94dd3a41be2fMike Lockwood 487120b57a3d9703bccba534af335aa94dd3a41be2fMike Lockwood memset(&ctrl, 0, sizeof(ctrl)); 488120b57a3d9703bccba534af335aa94dd3a41be2fMike Lockwood ctrl.bRequestType = requestType; 489120b57a3d9703bccba534af335aa94dd3a41be2fMike Lockwood ctrl.bRequest = request; 490120b57a3d9703bccba534af335aa94dd3a41be2fMike Lockwood ctrl.wValue = value; 491120b57a3d9703bccba534af335aa94dd3a41be2fMike Lockwood ctrl.wIndex = index; 492120b57a3d9703bccba534af335aa94dd3a41be2fMike Lockwood ctrl.wLength = length; 493120b57a3d9703bccba534af335aa94dd3a41be2fMike Lockwood ctrl.data = buffer; 494120b57a3d9703bccba534af335aa94dd3a41be2fMike Lockwood ctrl.timeout = timeout; 495120b57a3d9703bccba534af335aa94dd3a41be2fMike Lockwood return ioctl(device->fd, USBDEVFS_CONTROL, &ctrl); 496120b57a3d9703bccba534af335aa94dd3a41be2fMike Lockwood} 497120b57a3d9703bccba534af335aa94dd3a41be2fMike Lockwood 498120b57a3d9703bccba534af335aa94dd3a41be2fMike Lockwoodint usb_device_bulk_transfer(struct usb_device *device, 499120b57a3d9703bccba534af335aa94dd3a41be2fMike Lockwood int endpoint, 500120b57a3d9703bccba534af335aa94dd3a41be2fMike Lockwood void* buffer, 501120b57a3d9703bccba534af335aa94dd3a41be2fMike Lockwood int length, 502120b57a3d9703bccba534af335aa94dd3a41be2fMike Lockwood unsigned int timeout) 503120b57a3d9703bccba534af335aa94dd3a41be2fMike Lockwood{ 504120b57a3d9703bccba534af335aa94dd3a41be2fMike Lockwood struct usbdevfs_bulktransfer ctrl; 505120b57a3d9703bccba534af335aa94dd3a41be2fMike Lockwood 506c4c00d8e6a215020be87f6702844267e105e1f0eMike Lockwood // need to limit request size to avoid EINVAL 507c4c00d8e6a215020be87f6702844267e105e1f0eMike Lockwood if (length > MAX_USBFS_BUFFER_SIZE) 508c4c00d8e6a215020be87f6702844267e105e1f0eMike Lockwood length = MAX_USBFS_BUFFER_SIZE; 509c4c00d8e6a215020be87f6702844267e105e1f0eMike Lockwood 510120b57a3d9703bccba534af335aa94dd3a41be2fMike Lockwood memset(&ctrl, 0, sizeof(ctrl)); 511120b57a3d9703bccba534af335aa94dd3a41be2fMike Lockwood ctrl.ep = endpoint; 512120b57a3d9703bccba534af335aa94dd3a41be2fMike Lockwood ctrl.len = length; 513120b57a3d9703bccba534af335aa94dd3a41be2fMike Lockwood ctrl.data = buffer; 514120b57a3d9703bccba534af335aa94dd3a41be2fMike Lockwood ctrl.timeout = timeout; 515120b57a3d9703bccba534af335aa94dd3a41be2fMike Lockwood return ioctl(device->fd, USBDEVFS_BULK, &ctrl); 516120b57a3d9703bccba534af335aa94dd3a41be2fMike Lockwood} 517120b57a3d9703bccba534af335aa94dd3a41be2fMike Lockwood 518e533c5f1005e8913f577d2aeac5a26f88f55a249Mike Lockwoodstruct usb_request *usb_request_new(struct usb_device *dev, 519e533c5f1005e8913f577d2aeac5a26f88f55a249Mike Lockwood const struct usb_endpoint_descriptor *ep_desc) 52030ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood{ 521e533c5f1005e8913f577d2aeac5a26f88f55a249Mike Lockwood struct usbdevfs_urb *urb = calloc(1, sizeof(struct usbdevfs_urb)); 522e533c5f1005e8913f577d2aeac5a26f88f55a249Mike Lockwood if (!urb) 523e533c5f1005e8913f577d2aeac5a26f88f55a249Mike Lockwood return NULL; 524e533c5f1005e8913f577d2aeac5a26f88f55a249Mike Lockwood 525e533c5f1005e8913f577d2aeac5a26f88f55a249Mike Lockwood if ((ep_desc->bmAttributes & USB_ENDPOINT_XFERTYPE_MASK) == USB_ENDPOINT_XFER_BULK) 526e533c5f1005e8913f577d2aeac5a26f88f55a249Mike Lockwood urb->type = USBDEVFS_URB_TYPE_BULK; 527e533c5f1005e8913f577d2aeac5a26f88f55a249Mike Lockwood else if ((ep_desc->bmAttributes & USB_ENDPOINT_XFERTYPE_MASK) == USB_ENDPOINT_XFER_INT) 528e533c5f1005e8913f577d2aeac5a26f88f55a249Mike Lockwood urb->type = USBDEVFS_URB_TYPE_INTERRUPT; 529e533c5f1005e8913f577d2aeac5a26f88f55a249Mike Lockwood else { 530e533c5f1005e8913f577d2aeac5a26f88f55a249Mike Lockwood D("Unsupported endpoint type %d", ep_desc->bmAttributes & USB_ENDPOINT_XFERTYPE_MASK); 531e533c5f1005e8913f577d2aeac5a26f88f55a249Mike Lockwood free(urb); 532e533c5f1005e8913f577d2aeac5a26f88f55a249Mike Lockwood return NULL; 533e533c5f1005e8913f577d2aeac5a26f88f55a249Mike Lockwood } 534e533c5f1005e8913f577d2aeac5a26f88f55a249Mike Lockwood urb->endpoint = ep_desc->bEndpointAddress; 535e533c5f1005e8913f577d2aeac5a26f88f55a249Mike Lockwood 536e533c5f1005e8913f577d2aeac5a26f88f55a249Mike Lockwood struct usb_request *req = calloc(1, sizeof(struct usb_request)); 537e533c5f1005e8913f577d2aeac5a26f88f55a249Mike Lockwood if (!req) { 538e533c5f1005e8913f577d2aeac5a26f88f55a249Mike Lockwood free(urb); 539e533c5f1005e8913f577d2aeac5a26f88f55a249Mike Lockwood return NULL; 540e533c5f1005e8913f577d2aeac5a26f88f55a249Mike Lockwood } 541e533c5f1005e8913f577d2aeac5a26f88f55a249Mike Lockwood 542e533c5f1005e8913f577d2aeac5a26f88f55a249Mike Lockwood req->dev = dev; 543e533c5f1005e8913f577d2aeac5a26f88f55a249Mike Lockwood req->max_packet_size = __le16_to_cpu(ep_desc->wMaxPacketSize); 544e533c5f1005e8913f577d2aeac5a26f88f55a249Mike Lockwood req->private_data = urb; 545b5d68a3c28d0b7a947373344cbda2a2369d0b67dMike Lockwood req->endpoint = urb->endpoint; 546e533c5f1005e8913f577d2aeac5a26f88f55a249Mike Lockwood urb->usercontext = req; 547e533c5f1005e8913f577d2aeac5a26f88f55a249Mike Lockwood 548e533c5f1005e8913f577d2aeac5a26f88f55a249Mike Lockwood return req; 54930ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood} 55030ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 551e533c5f1005e8913f577d2aeac5a26f88f55a249Mike Lockwoodvoid usb_request_free(struct usb_request *req) 55230ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood{ 553e533c5f1005e8913f577d2aeac5a26f88f55a249Mike Lockwood free(req->private_data); 554e533c5f1005e8913f577d2aeac5a26f88f55a249Mike Lockwood free(req); 55530ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood} 55630ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 557e533c5f1005e8913f577d2aeac5a26f88f55a249Mike Lockwoodint usb_request_queue(struct usb_request *req) 55830ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood{ 559e533c5f1005e8913f577d2aeac5a26f88f55a249Mike Lockwood struct usbdevfs_urb *urb = (struct usbdevfs_urb*)req->private_data; 56030ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood int res; 56130ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 56230ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood urb->status = -1; 563e533c5f1005e8913f577d2aeac5a26f88f55a249Mike Lockwood urb->buffer = req->buffer; 564c4c00d8e6a215020be87f6702844267e105e1f0eMike Lockwood // need to limit request size to avoid EINVAL 565c4c00d8e6a215020be87f6702844267e105e1f0eMike Lockwood if (req->buffer_length > MAX_USBFS_BUFFER_SIZE) 566c4c00d8e6a215020be87f6702844267e105e1f0eMike Lockwood urb->buffer_length = MAX_USBFS_BUFFER_SIZE; 567c4c00d8e6a215020be87f6702844267e105e1f0eMike Lockwood else 568c4c00d8e6a215020be87f6702844267e105e1f0eMike Lockwood urb->buffer_length = req->buffer_length; 56930ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 57030ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood do { 571e533c5f1005e8913f577d2aeac5a26f88f55a249Mike Lockwood res = ioctl(req->dev->fd, USBDEVFS_SUBMITURB, urb); 57230ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood } while((res < 0) && (errno == EINTR)); 57330ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 57430ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood return res; 57530ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood} 57630ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 577e533c5f1005e8913f577d2aeac5a26f88f55a249Mike Lockwoodstruct usb_request *usb_request_wait(struct usb_device *dev) 57830ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood{ 579e533c5f1005e8913f577d2aeac5a26f88f55a249Mike Lockwood struct usbdevfs_urb *urb = NULL; 580e533c5f1005e8913f577d2aeac5a26f88f55a249Mike Lockwood struct usb_request *req = NULL; 58130ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood int res; 58230ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 58330ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood while (1) { 584e533c5f1005e8913f577d2aeac5a26f88f55a249Mike Lockwood int res = ioctl(dev->fd, USBDEVFS_REAPURB, &urb); 58530ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood D("USBDEVFS_REAPURB returned %d\n", res); 58630ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood if (res < 0) { 58730ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood if(errno == EINTR) { 58830ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood continue; 58930ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood } 59030ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood D("[ reap urb - error ]\n"); 591e533c5f1005e8913f577d2aeac5a26f88f55a249Mike Lockwood return NULL; 59230ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood } else { 59330ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood D("[ urb @%p status = %d, actual = %d ]\n", 594e533c5f1005e8913f577d2aeac5a26f88f55a249Mike Lockwood urb, urb->status, urb->actual_length); 595e533c5f1005e8913f577d2aeac5a26f88f55a249Mike Lockwood req = (struct usb_request*)urb->usercontext; 596e533c5f1005e8913f577d2aeac5a26f88f55a249Mike Lockwood req->actual_length = urb->actual_length; 59730ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood } 59830ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood break; 59930ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood } 600e533c5f1005e8913f577d2aeac5a26f88f55a249Mike Lockwood return req; 60130ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood} 60230ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 603e533c5f1005e8913f577d2aeac5a26f88f55a249Mike Lockwoodint usb_request_cancel(struct usb_request *req) 60430ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood{ 605e533c5f1005e8913f577d2aeac5a26f88f55a249Mike Lockwood struct usbdevfs_urb *urb = ((struct usbdevfs_urb*)req->private_data); 606e533c5f1005e8913f577d2aeac5a26f88f55a249Mike Lockwood return ioctl(req->dev->fd, USBDEVFS_DISCARDURB, &urb); 60730ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood} 60830ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 609