usbhost.c revision dfd21b89f28bd8a6d4acdc05b74fbd03bb844f48
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> 36dea46b6657845a366d13f57c720eab28c9062ab7Guillaume Ranquet#include <stddef.h> 3730ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 3830ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood#include <sys/ioctl.h> 3930ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood#include <sys/types.h> 4030ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood#include <sys/time.h> 4130ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood#include <sys/inotify.h> 4230ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood#include <dirent.h> 4330ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood#include <fcntl.h> 4430ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood#include <errno.h> 4530ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood#include <ctype.h> 4630ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood#include <pthread.h> 4730ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 4830ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood#include <linux/usbdevice_fs.h> 4930ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood#include <asm/byteorder.h> 5030ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 5130ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood#include "usbhost/usbhost.h" 5230ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 53f4de078388242fff9b68c04b122e8a095cab9b0eBenoit Goby#define DEV_DIR "/dev" 54a306ced1ac383557dabfb38c70e5f5e2a2ec0510Ziv Hendel#define DEV_BUS_DIR DEV_DIR "/bus" 55a306ced1ac383557dabfb38c70e5f5e2a2ec0510Ziv Hendel#define USB_FS_DIR DEV_BUS_DIR "/usb" 56dea46b6657845a366d13f57c720eab28c9062ab7Guillaume Ranquet#define USB_FS_ID_SCANNER USB_FS_DIR "/%d/%d" 57dea46b6657845a366d13f57c720eab28c9062ab7Guillaume Ranquet#define USB_FS_ID_FORMAT USB_FS_DIR "/%03d/%03d" 5830ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 590dd1aab7b5184f41ec838def8493d16cfe70b739Mike Lockwood// Some devices fail to send string descriptors if we attempt reading > 255 bytes 600dd1aab7b5184f41ec838def8493d16cfe70b739Mike Lockwood#define MAX_STRING_DESCRIPTOR_LENGTH 255 610dd1aab7b5184f41ec838def8493d16cfe70b739Mike Lockwood 62c4c00d8e6a215020be87f6702844267e105e1f0eMike Lockwood// From drivers/usb/core/devio.c 63c4c00d8e6a215020be87f6702844267e105e1f0eMike Lockwood// I don't know why this isn't in a kernel header 64c4c00d8e6a215020be87f6702844267e105e1f0eMike Lockwood#define MAX_USBFS_BUFFER_SIZE 16384 6530ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 66dea46b6657845a366d13f57c720eab28c9062ab7Guillaume Ranquet#define MAX_USBFS_WD_COUNT 10 67dea46b6657845a366d13f57c720eab28c9062ab7Guillaume Ranquet 686ac3aa157493ef24bc837b679dd8292fad8961e0Mike Lockwoodstruct usb_host_context { 69dea46b6657845a366d13f57c720eab28c9062ab7Guillaume Ranquet int fd; 70dea46b6657845a366d13f57c720eab28c9062ab7Guillaume Ranquet usb_device_added_cb cb_added; 71dea46b6657845a366d13f57c720eab28c9062ab7Guillaume Ranquet usb_device_removed_cb cb_removed; 72dea46b6657845a366d13f57c720eab28c9062ab7Guillaume Ranquet void *data; 73dea46b6657845a366d13f57c720eab28c9062ab7Guillaume Ranquet int wds[MAX_USBFS_WD_COUNT]; 74dea46b6657845a366d13f57c720eab28c9062ab7Guillaume Ranquet int wdd; 75a306ced1ac383557dabfb38c70e5f5e2a2ec0510Ziv Hendel int wddbus; 766ac3aa157493ef24bc837b679dd8292fad8961e0Mike Lockwood}; 776ac3aa157493ef24bc837b679dd8292fad8961e0Mike Lockwood 7830ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwoodstruct usb_device { 7930ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood char dev_name[64]; 80ec9e7b1c1844e66c39a4f63ded8208c1717380f8Mike Lockwood unsigned char desc[4096]; 8130ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood int desc_length; 8230ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood int fd; 8330ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood int writeable; 8430ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood}; 8530ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 8630ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwoodstatic inline int badname(const char *name) 8730ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood{ 8830ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood while(*name) { 8930ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood if(!isdigit(*name++)) return 1; 9030ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood } 9130ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood return 0; 9230ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood} 9330ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 946cc883ca098f34bd126478a6aa19d5cce48d71a9Benoit Gobystatic int find_existing_devices_bus(char *busname, 956cc883ca098f34bd126478a6aa19d5cce48d71a9Benoit Goby usb_device_added_cb added_cb, 966cc883ca098f34bd126478a6aa19d5cce48d71a9Benoit Goby void *client_data) 976cc883ca098f34bd126478a6aa19d5cce48d71a9Benoit Goby{ 986cc883ca098f34bd126478a6aa19d5cce48d71a9Benoit Goby char devname[32]; 996cc883ca098f34bd126478a6aa19d5cce48d71a9Benoit Goby DIR *devdir; 1006cc883ca098f34bd126478a6aa19d5cce48d71a9Benoit Goby struct dirent *de; 1016cc883ca098f34bd126478a6aa19d5cce48d71a9Benoit Goby int done = 0; 1026cc883ca098f34bd126478a6aa19d5cce48d71a9Benoit Goby 1036cc883ca098f34bd126478a6aa19d5cce48d71a9Benoit Goby devdir = opendir(busname); 1046cc883ca098f34bd126478a6aa19d5cce48d71a9Benoit Goby if(devdir == 0) return 0; 1056cc883ca098f34bd126478a6aa19d5cce48d71a9Benoit Goby 1066cc883ca098f34bd126478a6aa19d5cce48d71a9Benoit Goby while ((de = readdir(devdir)) && !done) { 1076cc883ca098f34bd126478a6aa19d5cce48d71a9Benoit Goby if(badname(de->d_name)) continue; 1086cc883ca098f34bd126478a6aa19d5cce48d71a9Benoit Goby 1096cc883ca098f34bd126478a6aa19d5cce48d71a9Benoit Goby snprintf(devname, sizeof(devname), "%s/%s", busname, de->d_name); 1106cc883ca098f34bd126478a6aa19d5cce48d71a9Benoit Goby done = added_cb(devname, client_data); 1116cc883ca098f34bd126478a6aa19d5cce48d71a9Benoit Goby } // end of devdir while 1126cc883ca098f34bd126478a6aa19d5cce48d71a9Benoit Goby closedir(devdir); 1136cc883ca098f34bd126478a6aa19d5cce48d71a9Benoit Goby 1146cc883ca098f34bd126478a6aa19d5cce48d71a9Benoit Goby return done; 1156cc883ca098f34bd126478a6aa19d5cce48d71a9Benoit Goby} 1166cc883ca098f34bd126478a6aa19d5cce48d71a9Benoit Goby 1177a96ba436c9a2bacc64e712bdb53bd7accc5c3a9Mike Lockwood/* returns true if one of the callbacks indicates we are done */ 1187a96ba436c9a2bacc64e712bdb53bd7accc5c3a9Mike Lockwoodstatic int find_existing_devices(usb_device_added_cb added_cb, 1197a96ba436c9a2bacc64e712bdb53bd7accc5c3a9Mike Lockwood void *client_data) 12030ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood{ 1216cc883ca098f34bd126478a6aa19d5cce48d71a9Benoit Goby char busname[32]; 1226cc883ca098f34bd126478a6aa19d5cce48d71a9Benoit Goby DIR *busdir; 12330ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood struct dirent *de; 1247a96ba436c9a2bacc64e712bdb53bd7accc5c3a9Mike Lockwood int done = 0; 12530ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 12630ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood busdir = opendir(USB_FS_DIR); 127f4de078388242fff9b68c04b122e8a095cab9b0eBenoit Goby if(busdir == 0) return 0; 12830ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 1297a96ba436c9a2bacc64e712bdb53bd7accc5c3a9Mike Lockwood while ((de = readdir(busdir)) != 0 && !done) { 13030ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood if(badname(de->d_name)) continue; 13130ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 132dea46b6657845a366d13f57c720eab28c9062ab7Guillaume Ranquet snprintf(busname, sizeof(busname), USB_FS_DIR "/%s", de->d_name); 1336cc883ca098f34bd126478a6aa19d5cce48d71a9Benoit Goby done = find_existing_devices_bus(busname, added_cb, 1346cc883ca098f34bd126478a6aa19d5cce48d71a9Benoit Goby client_data); 135dea46b6657845a366d13f57c720eab28c9062ab7Guillaume Ranquet } //end of busdir while 13630ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood closedir(busdir); 1377a96ba436c9a2bacc64e712bdb53bd7accc5c3a9Mike Lockwood 1387a96ba436c9a2bacc64e712bdb53bd7accc5c3a9Mike Lockwood return done; 1397a96ba436c9a2bacc64e712bdb53bd7accc5c3a9Mike Lockwood} 1407a96ba436c9a2bacc64e712bdb53bd7accc5c3a9Mike Lockwood 141f4de078388242fff9b68c04b122e8a095cab9b0eBenoit Gobystatic void watch_existing_subdirs(struct usb_host_context *context, 142f4de078388242fff9b68c04b122e8a095cab9b0eBenoit Goby int *wds, int wd_count) 143f4de078388242fff9b68c04b122e8a095cab9b0eBenoit Goby{ 144f4de078388242fff9b68c04b122e8a095cab9b0eBenoit Goby char path[100]; 145f4de078388242fff9b68c04b122e8a095cab9b0eBenoit Goby int i, ret; 146f4de078388242fff9b68c04b122e8a095cab9b0eBenoit Goby 147f4de078388242fff9b68c04b122e8a095cab9b0eBenoit Goby wds[0] = inotify_add_watch(context->fd, USB_FS_DIR, IN_CREATE | IN_DELETE); 148f4de078388242fff9b68c04b122e8a095cab9b0eBenoit Goby if (wds[0] < 0) 149f4de078388242fff9b68c04b122e8a095cab9b0eBenoit Goby return; 150f4de078388242fff9b68c04b122e8a095cab9b0eBenoit Goby 151f4de078388242fff9b68c04b122e8a095cab9b0eBenoit Goby /* watch existing subdirectories of USB_FS_DIR */ 152f4de078388242fff9b68c04b122e8a095cab9b0eBenoit Goby for (i = 1; i < wd_count; i++) { 153dea46b6657845a366d13f57c720eab28c9062ab7Guillaume Ranquet snprintf(path, sizeof(path), USB_FS_DIR "/%03d", i); 154f4de078388242fff9b68c04b122e8a095cab9b0eBenoit Goby ret = inotify_add_watch(context->fd, path, IN_CREATE | IN_DELETE); 155f4de078388242fff9b68c04b122e8a095cab9b0eBenoit Goby if (ret >= 0) 156f4de078388242fff9b68c04b122e8a095cab9b0eBenoit Goby wds[i] = ret; 157f4de078388242fff9b68c04b122e8a095cab9b0eBenoit Goby } 158f4de078388242fff9b68c04b122e8a095cab9b0eBenoit Goby} 159f4de078388242fff9b68c04b122e8a095cab9b0eBenoit Goby 1607a96ba436c9a2bacc64e712bdb53bd7accc5c3a9Mike Lockwoodstruct usb_host_context *usb_host_init() 1617a96ba436c9a2bacc64e712bdb53bd7accc5c3a9Mike Lockwood{ 1627a96ba436c9a2bacc64e712bdb53bd7accc5c3a9Mike Lockwood struct usb_host_context *context = calloc(1, sizeof(struct usb_host_context)); 1637a96ba436c9a2bacc64e712bdb53bd7accc5c3a9Mike Lockwood if (!context) { 1647a96ba436c9a2bacc64e712bdb53bd7accc5c3a9Mike Lockwood fprintf(stderr, "out of memory in usb_host_context\n"); 1657a96ba436c9a2bacc64e712bdb53bd7accc5c3a9Mike Lockwood return NULL; 1667a96ba436c9a2bacc64e712bdb53bd7accc5c3a9Mike Lockwood } 1677a96ba436c9a2bacc64e712bdb53bd7accc5c3a9Mike Lockwood context->fd = inotify_init(); 1687a96ba436c9a2bacc64e712bdb53bd7accc5c3a9Mike Lockwood if (context->fd < 0) { 1697a96ba436c9a2bacc64e712bdb53bd7accc5c3a9Mike Lockwood fprintf(stderr, "inotify_init failed\n"); 1707a96ba436c9a2bacc64e712bdb53bd7accc5c3a9Mike Lockwood free(context); 1717a96ba436c9a2bacc64e712bdb53bd7accc5c3a9Mike Lockwood return NULL; 1727a96ba436c9a2bacc64e712bdb53bd7accc5c3a9Mike Lockwood } 1737a96ba436c9a2bacc64e712bdb53bd7accc5c3a9Mike Lockwood return context; 1747a96ba436c9a2bacc64e712bdb53bd7accc5c3a9Mike Lockwood} 1757a96ba436c9a2bacc64e712bdb53bd7accc5c3a9Mike Lockwood 1767a96ba436c9a2bacc64e712bdb53bd7accc5c3a9Mike Lockwoodvoid usb_host_cleanup(struct usb_host_context *context) 1777a96ba436c9a2bacc64e712bdb53bd7accc5c3a9Mike Lockwood{ 1787a96ba436c9a2bacc64e712bdb53bd7accc5c3a9Mike Lockwood close(context->fd); 1797a96ba436c9a2bacc64e712bdb53bd7accc5c3a9Mike Lockwood free(context); 18030ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood} 18130ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 182dea46b6657845a366d13f57c720eab28c9062ab7Guillaume Ranquetint usb_host_get_fd(struct usb_host_context *context) 183dea46b6657845a366d13f57c720eab28c9062ab7Guillaume Ranquet{ 184dea46b6657845a366d13f57c720eab28c9062ab7Guillaume Ranquet return context->fd; 185dea46b6657845a366d13f57c720eab28c9062ab7Guillaume Ranquet} /* usb_host_get_fd() */ 186dea46b6657845a366d13f57c720eab28c9062ab7Guillaume Ranquet 187dea46b6657845a366d13f57c720eab28c9062ab7Guillaume Ranquetint usb_host_load(struct usb_host_context *context, 1887a96ba436c9a2bacc64e712bdb53bd7accc5c3a9Mike Lockwood usb_device_added_cb added_cb, 1897a96ba436c9a2bacc64e712bdb53bd7accc5c3a9Mike Lockwood usb_device_removed_cb removed_cb, 190a805519ceedc53afa5453a6d8a7d80038d885d9fMike Lockwood usb_discovery_done_cb discovery_done_cb, 1917a96ba436c9a2bacc64e712bdb53bd7accc5c3a9Mike Lockwood void *client_data) 19230ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood{ 193dea46b6657845a366d13f57c720eab28c9062ab7Guillaume Ranquet int done = 0; 194dea46b6657845a366d13f57c720eab28c9062ab7Guillaume Ranquet int i; 195dea46b6657845a366d13f57c720eab28c9062ab7Guillaume Ranquet 196dea46b6657845a366d13f57c720eab28c9062ab7Guillaume Ranquet context->cb_added = added_cb; 197dea46b6657845a366d13f57c720eab28c9062ab7Guillaume Ranquet context->cb_removed = removed_cb; 198dea46b6657845a366d13f57c720eab28c9062ab7Guillaume Ranquet context->data = client_data; 19930ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 20030ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood D("Created device discovery thread\n"); 20130ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 20230ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood /* watch for files added and deleted within USB_FS_DIR */ 203a306ced1ac383557dabfb38c70e5f5e2a2ec0510Ziv Hendel context->wddbus = -1; 204dea46b6657845a366d13f57c720eab28c9062ab7Guillaume Ranquet for (i = 0; i < MAX_USBFS_WD_COUNT; i++) 205dea46b6657845a366d13f57c720eab28c9062ab7Guillaume Ranquet context->wds[i] = -1; 206f4de078388242fff9b68c04b122e8a095cab9b0eBenoit Goby 20730ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood /* watch the root for new subdirectories */ 208dea46b6657845a366d13f57c720eab28c9062ab7Guillaume Ranquet context->wdd = inotify_add_watch(context->fd, DEV_DIR, IN_CREATE | IN_DELETE); 209dea46b6657845a366d13f57c720eab28c9062ab7Guillaume Ranquet if (context->wdd < 0) { 21030ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood fprintf(stderr, "inotify_add_watch failed\n"); 211e8849d190a3097274dcb64416e564538a1017054Mike Lockwood if (discovery_done_cb) 212e8849d190a3097274dcb64416e564538a1017054Mike Lockwood discovery_done_cb(client_data); 213dea46b6657845a366d13f57c720eab28c9062ab7Guillaume Ranquet return done; 21430ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood } 21530ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 216dea46b6657845a366d13f57c720eab28c9062ab7Guillaume Ranquet watch_existing_subdirs(context, context->wds, MAX_USBFS_WD_COUNT); 21730ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 21830ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood /* check for existing devices first, after we have inotify set up */ 2196cc883ca098f34bd126478a6aa19d5cce48d71a9Benoit Goby done = find_existing_devices(added_cb, client_data); 220a805519ceedc53afa5453a6d8a7d80038d885d9fMike Lockwood if (discovery_done_cb) 221a805519ceedc53afa5453a6d8a7d80038d885d9fMike Lockwood done |= discovery_done_cb(client_data); 22230ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 223dea46b6657845a366d13f57c720eab28c9062ab7Guillaume Ranquet return done; 224dea46b6657845a366d13f57c720eab28c9062ab7Guillaume Ranquet} /* usb_host_load() */ 225dea46b6657845a366d13f57c720eab28c9062ab7Guillaume Ranquet 226dea46b6657845a366d13f57c720eab28c9062ab7Guillaume Ranquetint usb_host_read_event(struct usb_host_context *context) 227dea46b6657845a366d13f57c720eab28c9062ab7Guillaume Ranquet{ 228dea46b6657845a366d13f57c720eab28c9062ab7Guillaume Ranquet struct inotify_event* event; 229dea46b6657845a366d13f57c720eab28c9062ab7Guillaume Ranquet char event_buf[512]; 230dea46b6657845a366d13f57c720eab28c9062ab7Guillaume Ranquet char path[100]; 231dea46b6657845a366d13f57c720eab28c9062ab7Guillaume Ranquet int i, ret, done = 0; 232f75ea8d082ff39e316bd4d73979b610cc4b5e4bcZiv Hendel int offset = 0; 233dea46b6657845a366d13f57c720eab28c9062ab7Guillaume Ranquet int wd; 234dea46b6657845a366d13f57c720eab28c9062ab7Guillaume Ranquet 235dea46b6657845a366d13f57c720eab28c9062ab7Guillaume Ranquet ret = read(context->fd, event_buf, sizeof(event_buf)); 236dea46b6657845a366d13f57c720eab28c9062ab7Guillaume Ranquet if (ret >= (int)sizeof(struct inotify_event)) { 237a306ced1ac383557dabfb38c70e5f5e2a2ec0510Ziv Hendel while (offset < ret && !done) { 238f75ea8d082ff39e316bd4d73979b610cc4b5e4bcZiv Hendel event = (struct inotify_event*)&event_buf[offset]; 239f75ea8d082ff39e316bd4d73979b610cc4b5e4bcZiv Hendel done = 0; 240f75ea8d082ff39e316bd4d73979b610cc4b5e4bcZiv Hendel wd = event->wd; 241f75ea8d082ff39e316bd4d73979b610cc4b5e4bcZiv Hendel if (wd == context->wdd) { 242f75ea8d082ff39e316bd4d73979b610cc4b5e4bcZiv Hendel if ((event->mask & IN_CREATE) && !strcmp(event->name, "bus")) { 243a306ced1ac383557dabfb38c70e5f5e2a2ec0510Ziv Hendel context->wddbus = inotify_add_watch(context->fd, DEV_BUS_DIR, IN_CREATE | IN_DELETE); 244a306ced1ac383557dabfb38c70e5f5e2a2ec0510Ziv Hendel if (context->wddbus < 0) { 245a306ced1ac383557dabfb38c70e5f5e2a2ec0510Ziv Hendel done = 1; 246a306ced1ac383557dabfb38c70e5f5e2a2ec0510Ziv Hendel } else { 247a306ced1ac383557dabfb38c70e5f5e2a2ec0510Ziv Hendel watch_existing_subdirs(context, context->wds, MAX_USBFS_WD_COUNT); 248a306ced1ac383557dabfb38c70e5f5e2a2ec0510Ziv Hendel done = find_existing_devices(context->cb_added, context->data); 249a306ced1ac383557dabfb38c70e5f5e2a2ec0510Ziv Hendel } 250a306ced1ac383557dabfb38c70e5f5e2a2ec0510Ziv Hendel } 251a306ced1ac383557dabfb38c70e5f5e2a2ec0510Ziv Hendel } else if (wd == context->wddbus) { 252a306ced1ac383557dabfb38c70e5f5e2a2ec0510Ziv Hendel if ((event->mask & IN_CREATE) && !strcmp(event->name, "usb")) { 253f75ea8d082ff39e316bd4d73979b610cc4b5e4bcZiv Hendel watch_existing_subdirs(context, context->wds, MAX_USBFS_WD_COUNT); 254f75ea8d082ff39e316bd4d73979b610cc4b5e4bcZiv Hendel done = find_existing_devices(context->cb_added, context->data); 255a306ced1ac383557dabfb38c70e5f5e2a2ec0510Ziv Hendel } else if ((event->mask & IN_DELETE) && !strcmp(event->name, "usb")) { 256f75ea8d082ff39e316bd4d73979b610cc4b5e4bcZiv Hendel for (i = 0; i < MAX_USBFS_WD_COUNT; i++) { 257f75ea8d082ff39e316bd4d73979b610cc4b5e4bcZiv Hendel if (context->wds[i] >= 0) { 258f75ea8d082ff39e316bd4d73979b610cc4b5e4bcZiv Hendel inotify_rm_watch(context->fd, context->wds[i]); 259f75ea8d082ff39e316bd4d73979b610cc4b5e4bcZiv Hendel context->wds[i] = -1; 260f75ea8d082ff39e316bd4d73979b610cc4b5e4bcZiv Hendel } 261f75ea8d082ff39e316bd4d73979b610cc4b5e4bcZiv Hendel } 262f75ea8d082ff39e316bd4d73979b610cc4b5e4bcZiv Hendel } 263f75ea8d082ff39e316bd4d73979b610cc4b5e4bcZiv Hendel } else if (wd == context->wds[0]) { 264f75ea8d082ff39e316bd4d73979b610cc4b5e4bcZiv Hendel i = atoi(event->name); 265f75ea8d082ff39e316bd4d73979b610cc4b5e4bcZiv Hendel snprintf(path, sizeof(path), USB_FS_DIR "/%s", event->name); 266f75ea8d082ff39e316bd4d73979b610cc4b5e4bcZiv Hendel D("%s subdirectory %s: index: %d\n", (event->mask & IN_CREATE) ? 267f75ea8d082ff39e316bd4d73979b610cc4b5e4bcZiv Hendel "new" : "gone", path, i); 268f75ea8d082ff39e316bd4d73979b610cc4b5e4bcZiv Hendel if (i > 0 && i < MAX_USBFS_WD_COUNT) { 2693c1d7b34c151ec1669e0d190a0839718242682c9Bo Huang int local_ret = 0; 270f75ea8d082ff39e316bd4d73979b610cc4b5e4bcZiv Hendel if (event->mask & IN_CREATE) { 2713c1d7b34c151ec1669e0d190a0839718242682c9Bo Huang local_ret = inotify_add_watch(context->fd, path, 272f75ea8d082ff39e316bd4d73979b610cc4b5e4bcZiv Hendel IN_CREATE | IN_DELETE); 2733c1d7b34c151ec1669e0d190a0839718242682c9Bo Huang if (local_ret >= 0) 2743c1d7b34c151ec1669e0d190a0839718242682c9Bo Huang context->wds[i] = local_ret; 275f75ea8d082ff39e316bd4d73979b610cc4b5e4bcZiv Hendel done = find_existing_devices_bus(path, context->cb_added, 276f75ea8d082ff39e316bd4d73979b610cc4b5e4bcZiv Hendel context->data); 277f75ea8d082ff39e316bd4d73979b610cc4b5e4bcZiv Hendel } else if (event->mask & IN_DELETE) { 278dea46b6657845a366d13f57c720eab28c9062ab7Guillaume Ranquet inotify_rm_watch(context->fd, context->wds[i]); 279dea46b6657845a366d13f57c720eab28c9062ab7Guillaume Ranquet context->wds[i] = -1; 280f4de078388242fff9b68c04b122e8a095cab9b0eBenoit Goby } 281f4de078388242fff9b68c04b122e8a095cab9b0eBenoit Goby } 282f75ea8d082ff39e316bd4d73979b610cc4b5e4bcZiv Hendel } else { 283f75ea8d082ff39e316bd4d73979b610cc4b5e4bcZiv Hendel for (i = 1; (i < MAX_USBFS_WD_COUNT) && !done; i++) { 284f75ea8d082ff39e316bd4d73979b610cc4b5e4bcZiv Hendel if (wd == context->wds[i]) { 285f75ea8d082ff39e316bd4d73979b610cc4b5e4bcZiv Hendel snprintf(path, sizeof(path), USB_FS_DIR "/%03d/%s", i, event->name); 286f75ea8d082ff39e316bd4d73979b610cc4b5e4bcZiv Hendel if (event->mask == IN_CREATE) { 287f75ea8d082ff39e316bd4d73979b610cc4b5e4bcZiv Hendel D("new device %s\n", path); 288f75ea8d082ff39e316bd4d73979b610cc4b5e4bcZiv Hendel done = context->cb_added(path, context->data); 289f75ea8d082ff39e316bd4d73979b610cc4b5e4bcZiv Hendel } else if (event->mask == IN_DELETE) { 290f75ea8d082ff39e316bd4d73979b610cc4b5e4bcZiv Hendel D("gone device %s\n", path); 291f75ea8d082ff39e316bd4d73979b610cc4b5e4bcZiv Hendel done = context->cb_removed(path, context->data); 292f75ea8d082ff39e316bd4d73979b610cc4b5e4bcZiv Hendel } 29330ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood } 29430ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood } 29530ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood } 296f75ea8d082ff39e316bd4d73979b610cc4b5e4bcZiv Hendel 297f75ea8d082ff39e316bd4d73979b610cc4b5e4bcZiv Hendel offset += sizeof(struct inotify_event) + event->len; 29830ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood } 29930ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood } 300dea46b6657845a366d13f57c720eab28c9062ab7Guillaume Ranquet 301dea46b6657845a366d13f57c720eab28c9062ab7Guillaume Ranquet return done; 302dea46b6657845a366d13f57c720eab28c9062ab7Guillaume Ranquet} /* usb_host_read_event() */ 303dea46b6657845a366d13f57c720eab28c9062ab7Guillaume Ranquet 304dea46b6657845a366d13f57c720eab28c9062ab7Guillaume Ranquetvoid usb_host_run(struct usb_host_context *context, 305dea46b6657845a366d13f57c720eab28c9062ab7Guillaume Ranquet usb_device_added_cb added_cb, 306dea46b6657845a366d13f57c720eab28c9062ab7Guillaume Ranquet usb_device_removed_cb removed_cb, 307dea46b6657845a366d13f57c720eab28c9062ab7Guillaume Ranquet usb_discovery_done_cb discovery_done_cb, 308dea46b6657845a366d13f57c720eab28c9062ab7Guillaume Ranquet void *client_data) 309dea46b6657845a366d13f57c720eab28c9062ab7Guillaume Ranquet{ 310dea46b6657845a366d13f57c720eab28c9062ab7Guillaume Ranquet int done; 311dea46b6657845a366d13f57c720eab28c9062ab7Guillaume Ranquet 312dea46b6657845a366d13f57c720eab28c9062ab7Guillaume Ranquet done = usb_host_load(context, added_cb, removed_cb, discovery_done_cb, client_data); 313dea46b6657845a366d13f57c720eab28c9062ab7Guillaume Ranquet 314dea46b6657845a366d13f57c720eab28c9062ab7Guillaume Ranquet while (!done) { 315dea46b6657845a366d13f57c720eab28c9062ab7Guillaume Ranquet 316dea46b6657845a366d13f57c720eab28c9062ab7Guillaume Ranquet done = usb_host_read_event(context); 317dea46b6657845a366d13f57c720eab28c9062ab7Guillaume Ranquet } 318dea46b6657845a366d13f57c720eab28c9062ab7Guillaume Ranquet} /* usb_host_run() */ 31930ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 32030ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwoodstruct usb_device *usb_device_open(const char *dev_name) 32130ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood{ 322cd185f23cc6f062b252d1d19bca55e721290ee62Mike Lockwood int fd, did_retry = 0, writeable = 1; 32330ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 324ec9e7b1c1844e66c39a4f63ded8208c1717380f8Mike Lockwood D("usb_device_open %s\n", dev_name); 325ec9e7b1c1844e66c39a4f63ded8208c1717380f8Mike Lockwood 32630ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwoodretry: 32730ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood fd = open(dev_name, O_RDWR); 32830ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood if (fd < 0) { 32930ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood /* if we fail, see if have read-only access */ 33030ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood fd = open(dev_name, O_RDONLY); 331e15af09876c5e0301084f46b8036aed147cf9c24Mike Lockwood D("usb_device_open open returned %d errno %d\n", fd, errno); 332e15af09876c5e0301084f46b8036aed147cf9c24Mike Lockwood if (fd < 0 && (errno == EACCES || errno == ENOENT) && !did_retry) { 33330ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood /* work around race condition between inotify and permissions management */ 33430ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood sleep(1); 33530ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood did_retry = 1; 33630ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood goto retry; 33730ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood } 33830ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 339cd185f23cc6f062b252d1d19bca55e721290ee62Mike Lockwood if (fd < 0) 340cd185f23cc6f062b252d1d19bca55e721290ee62Mike Lockwood return NULL; 341cd185f23cc6f062b252d1d19bca55e721290ee62Mike Lockwood writeable = 0; 34230ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood D("[ usb open read-only %s fd = %d]\n", dev_name, fd); 34330ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood } 34430ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 345cd185f23cc6f062b252d1d19bca55e721290ee62Mike Lockwood struct usb_device* result = usb_device_new(dev_name, fd); 346cd185f23cc6f062b252d1d19bca55e721290ee62Mike Lockwood if (result) 347cd185f23cc6f062b252d1d19bca55e721290ee62Mike Lockwood result->writeable = writeable; 348cd185f23cc6f062b252d1d19bca55e721290ee62Mike Lockwood return result; 349cd185f23cc6f062b252d1d19bca55e721290ee62Mike Lockwood} 350cd185f23cc6f062b252d1d19bca55e721290ee62Mike Lockwood 351cd185f23cc6f062b252d1d19bca55e721290ee62Mike Lockwoodvoid usb_device_close(struct usb_device *device) 352cd185f23cc6f062b252d1d19bca55e721290ee62Mike Lockwood{ 353cd185f23cc6f062b252d1d19bca55e721290ee62Mike Lockwood close(device->fd); 354cd185f23cc6f062b252d1d19bca55e721290ee62Mike Lockwood free(device); 355cd185f23cc6f062b252d1d19bca55e721290ee62Mike Lockwood} 356cd185f23cc6f062b252d1d19bca55e721290ee62Mike Lockwood 357cd185f23cc6f062b252d1d19bca55e721290ee62Mike Lockwoodstruct usb_device *usb_device_new(const char *dev_name, int fd) 358cd185f23cc6f062b252d1d19bca55e721290ee62Mike Lockwood{ 359cd185f23cc6f062b252d1d19bca55e721290ee62Mike Lockwood struct usb_device *device = calloc(1, sizeof(struct usb_device)); 360cd185f23cc6f062b252d1d19bca55e721290ee62Mike Lockwood int length; 361cd185f23cc6f062b252d1d19bca55e721290ee62Mike Lockwood 362ec9e7b1c1844e66c39a4f63ded8208c1717380f8Mike Lockwood D("usb_device_new %s fd: %d\n", dev_name, fd); 363ec9e7b1c1844e66c39a4f63ded8208c1717380f8Mike Lockwood 364cd185f23cc6f062b252d1d19bca55e721290ee62Mike Lockwood if (lseek(fd, 0, SEEK_SET) != 0) 365cd185f23cc6f062b252d1d19bca55e721290ee62Mike Lockwood goto failed; 36630ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood length = read(fd, device->desc, sizeof(device->desc)); 367ec9e7b1c1844e66c39a4f63ded8208c1717380f8Mike Lockwood D("usb_device_new read returned %d errno %d\n", length, errno); 36830ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood if (length < 0) 369cd185f23cc6f062b252d1d19bca55e721290ee62Mike Lockwood goto failed; 37030ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 37193aff72d9b469f4b77468bab654cd65243b662e6Mike Lockwood strncpy(device->dev_name, dev_name, sizeof(device->dev_name) - 1); 37230ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood device->fd = fd; 37330ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood device->desc_length = length; 374cd185f23cc6f062b252d1d19bca55e721290ee62Mike Lockwood // assume we are writeable, since usb_device_get_fd will only return writeable fds 375cd185f23cc6f062b252d1d19bca55e721290ee62Mike Lockwood device->writeable = 1; 37630ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood return device; 377cd185f23cc6f062b252d1d19bca55e721290ee62Mike Lockwood 378cd185f23cc6f062b252d1d19bca55e721290ee62Mike Lockwoodfailed: 37930ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood close(fd); 38030ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood free(device); 38130ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood return NULL; 38230ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood} 38330ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 384cd185f23cc6f062b252d1d19bca55e721290ee62Mike Lockwoodstatic int usb_device_reopen_writeable(struct usb_device *device) 38530ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood{ 386cd185f23cc6f062b252d1d19bca55e721290ee62Mike Lockwood if (device->writeable) 387cd185f23cc6f062b252d1d19bca55e721290ee62Mike Lockwood return 1; 388cd185f23cc6f062b252d1d19bca55e721290ee62Mike Lockwood 389cd185f23cc6f062b252d1d19bca55e721290ee62Mike Lockwood int fd = open(device->dev_name, O_RDWR); 390cd185f23cc6f062b252d1d19bca55e721290ee62Mike Lockwood if (fd >= 0) { 391cd185f23cc6f062b252d1d19bca55e721290ee62Mike Lockwood close(device->fd); 392cd185f23cc6f062b252d1d19bca55e721290ee62Mike Lockwood device->fd = fd; 393cd185f23cc6f062b252d1d19bca55e721290ee62Mike Lockwood device->writeable = 1; 394cd185f23cc6f062b252d1d19bca55e721290ee62Mike Lockwood return 1; 395cd185f23cc6f062b252d1d19bca55e721290ee62Mike Lockwood } 396cd185f23cc6f062b252d1d19bca55e721290ee62Mike Lockwood D("usb_device_reopen_writeable failed errno %d\n", errno); 397cd185f23cc6f062b252d1d19bca55e721290ee62Mike Lockwood return 0; 398cd185f23cc6f062b252d1d19bca55e721290ee62Mike Lockwood} 399cd185f23cc6f062b252d1d19bca55e721290ee62Mike Lockwood 400cd185f23cc6f062b252d1d19bca55e721290ee62Mike Lockwoodint usb_device_get_fd(struct usb_device *device) 401cd185f23cc6f062b252d1d19bca55e721290ee62Mike Lockwood{ 402cd185f23cc6f062b252d1d19bca55e721290ee62Mike Lockwood if (!usb_device_reopen_writeable(device)) 403cd185f23cc6f062b252d1d19bca55e721290ee62Mike Lockwood return -1; 404cd185f23cc6f062b252d1d19bca55e721290ee62Mike Lockwood return device->fd; 40530ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood} 40630ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 40730ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwoodconst char* usb_device_get_name(struct usb_device *device) 40830ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood{ 40930ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood return device->dev_name; 41030ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood} 41130ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 412203f102028c4df33c191d8cd610775eba8d5366dMike Lockwoodint usb_device_get_unique_id(struct usb_device *device) 413203f102028c4df33c191d8cd610775eba8d5366dMike Lockwood{ 414203f102028c4df33c191d8cd610775eba8d5366dMike Lockwood int bus = 0, dev = 0; 415203f102028c4df33c191d8cd610775eba8d5366dMike Lockwood sscanf(device->dev_name, USB_FS_ID_SCANNER, &bus, &dev); 416203f102028c4df33c191d8cd610775eba8d5366dMike Lockwood return bus * 1000 + dev; 417203f102028c4df33c191d8cd610775eba8d5366dMike Lockwood} 418203f102028c4df33c191d8cd610775eba8d5366dMike Lockwood 41907eb4af174f31c449a86dd459e2c81702f74acf1Mike Lockwoodint usb_device_get_unique_id_from_name(const char* name) 42007eb4af174f31c449a86dd459e2c81702f74acf1Mike Lockwood{ 42107eb4af174f31c449a86dd459e2c81702f74acf1Mike Lockwood int bus = 0, dev = 0; 42207eb4af174f31c449a86dd459e2c81702f74acf1Mike Lockwood sscanf(name, USB_FS_ID_SCANNER, &bus, &dev); 42307eb4af174f31c449a86dd459e2c81702f74acf1Mike Lockwood return bus * 1000 + dev; 42407eb4af174f31c449a86dd459e2c81702f74acf1Mike Lockwood} 42507eb4af174f31c449a86dd459e2c81702f74acf1Mike Lockwood 4267d700f8bdce747a26e3ee4737683194d77286ba3Mike Lockwoodchar* usb_device_get_name_from_unique_id(int id) 4277d700f8bdce747a26e3ee4737683194d77286ba3Mike Lockwood{ 4287d700f8bdce747a26e3ee4737683194d77286ba3Mike Lockwood int bus = id / 1000; 4297d700f8bdce747a26e3ee4737683194d77286ba3Mike Lockwood int dev = id % 1000; 4307d700f8bdce747a26e3ee4737683194d77286ba3Mike Lockwood char* result = (char *)calloc(1, strlen(USB_FS_ID_FORMAT)); 4317d700f8bdce747a26e3ee4737683194d77286ba3Mike Lockwood snprintf(result, strlen(USB_FS_ID_FORMAT) - 1, USB_FS_ID_FORMAT, bus, dev); 4327d700f8bdce747a26e3ee4737683194d77286ba3Mike Lockwood return result; 4337d700f8bdce747a26e3ee4737683194d77286ba3Mike Lockwood} 4347d700f8bdce747a26e3ee4737683194d77286ba3Mike Lockwood 43530ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwooduint16_t usb_device_get_vendor_id(struct usb_device *device) 43630ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood{ 43730ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood struct usb_device_descriptor* desc = (struct usb_device_descriptor*)device->desc; 43830ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood return __le16_to_cpu(desc->idVendor); 43930ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood} 44030ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 44130ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwooduint16_t usb_device_get_product_id(struct usb_device *device) 44230ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood{ 44330ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood struct usb_device_descriptor* desc = (struct usb_device_descriptor*)device->desc; 44430ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood return __le16_to_cpu(desc->idProduct); 44530ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood} 44630ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 44750372073d2919480fb32d56cb3b91663b9fca0f1Mike Lockwoodconst struct usb_device_descriptor* usb_device_get_device_descriptor(struct usb_device *device) 44850372073d2919480fb32d56cb3b91663b9fca0f1Mike Lockwood{ 44950372073d2919480fb32d56cb3b91663b9fca0f1Mike Lockwood return (struct usb_device_descriptor*)device->desc; 45050372073d2919480fb32d56cb3b91663b9fca0f1Mike Lockwood} 45150372073d2919480fb32d56cb3b91663b9fca0f1Mike Lockwood 452dfd21b89f28bd8a6d4acdc05b74fbd03bb844f48Vitalii Tomkivchar* usb_device_get_string(struct usb_device *device, int id, int timeout) 4531b7d991b433cf6d6fae4f40cb37f9b6c6043cfbcMike Lockwood{ 4541b7d991b433cf6d6fae4f40cb37f9b6c6043cfbcMike Lockwood char string[256]; 4550dd1aab7b5184f41ec838def8493d16cfe70b739Mike Lockwood __u16 buffer[MAX_STRING_DESCRIPTOR_LENGTH / sizeof(__u16)]; 4560dd1aab7b5184f41ec838def8493d16cfe70b739Mike Lockwood __u16 languages[MAX_STRING_DESCRIPTOR_LENGTH / sizeof(__u16)]; 4571b7d991b433cf6d6fae4f40cb37f9b6c6043cfbcMike Lockwood int i, result; 4581b7d991b433cf6d6fae4f40cb37f9b6c6043cfbcMike Lockwood int languageCount = 0; 4591b7d991b433cf6d6fae4f40cb37f9b6c6043cfbcMike Lockwood 460d2e798b53039f35967705acd5f6c399742f97e72Mike Lockwood if (id == 0) return NULL; 461d2e798b53039f35967705acd5f6c399742f97e72Mike Lockwood 4621b7d991b433cf6d6fae4f40cb37f9b6c6043cfbcMike Lockwood string[0] = 0; 4631b7d991b433cf6d6fae4f40cb37f9b6c6043cfbcMike Lockwood memset(languages, 0, sizeof(languages)); 46430ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 46530ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood // read list of supported languages 466120b57a3d9703bccba534af335aa94dd3a41be2fMike Lockwood result = usb_device_control_transfer(device, 4671b7d991b433cf6d6fae4f40cb37f9b6c6043cfbcMike Lockwood USB_DIR_IN|USB_TYPE_STANDARD|USB_RECIP_DEVICE, USB_REQ_GET_DESCRIPTOR, 468dfd21b89f28bd8a6d4acdc05b74fbd03bb844f48Vitalii Tomkiv (USB_DT_STRING << 8) | 0, 0, languages, sizeof(languages), 469dfd21b89f28bd8a6d4acdc05b74fbd03bb844f48Vitalii Tomkiv timeout); 47030ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood if (result > 0) 47130ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood languageCount = (result - 2) / 2; 47230ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 47330ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood for (i = 1; i <= languageCount; i++) { 47430ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood memset(buffer, 0, sizeof(buffer)); 47530ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 476120b57a3d9703bccba534af335aa94dd3a41be2fMike Lockwood result = usb_device_control_transfer(device, 4771b7d991b433cf6d6fae4f40cb37f9b6c6043cfbcMike Lockwood USB_DIR_IN|USB_TYPE_STANDARD|USB_RECIP_DEVICE, USB_REQ_GET_DESCRIPTOR, 478dfd21b89f28bd8a6d4acdc05b74fbd03bb844f48Vitalii Tomkiv (USB_DT_STRING << 8) | id, languages[i], buffer, sizeof(buffer), 479dfd21b89f28bd8a6d4acdc05b74fbd03bb844f48Vitalii Tomkiv timeout); 48030ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood if (result > 0) { 48130ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood int i; 48230ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood // skip first word, and copy the rest to the string, changing shorts to bytes. 48330ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood result /= 2; 48430ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood for (i = 1; i < result; i++) 48530ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood string[i - 1] = buffer[i]; 48630ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood string[i - 1] = 0; 48730ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood return strdup(string); 48830ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood } 48930ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood } 49030ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 49130ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood return NULL; 49230ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood} 49330ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 494dfd21b89f28bd8a6d4acdc05b74fbd03bb844f48Vitalii Tomkivchar* usb_device_get_manufacturer_name(struct usb_device *device, int timeout) 49530ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood{ 49630ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood struct usb_device_descriptor *desc = (struct usb_device_descriptor *)device->desc; 497dfd21b89f28bd8a6d4acdc05b74fbd03bb844f48Vitalii Tomkiv return usb_device_get_string(device, desc->iManufacturer, timeout); 49830ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood} 49930ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 500dfd21b89f28bd8a6d4acdc05b74fbd03bb844f48Vitalii Tomkivchar* usb_device_get_product_name(struct usb_device *device, int timeout) 50130ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood{ 50230ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood struct usb_device_descriptor *desc = (struct usb_device_descriptor *)device->desc; 503dfd21b89f28bd8a6d4acdc05b74fbd03bb844f48Vitalii Tomkiv return usb_device_get_string(device, desc->iProduct, timeout); 50430ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood} 50530ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 506f68600abfc7f1e2d64a4737630feea43bdaa85dcMike Lockwoodint usb_device_get_version(struct usb_device *device) 507f68600abfc7f1e2d64a4737630feea43bdaa85dcMike Lockwood{ 508f68600abfc7f1e2d64a4737630feea43bdaa85dcMike Lockwood struct usb_device_descriptor *desc = (struct usb_device_descriptor *)device->desc; 509f68600abfc7f1e2d64a4737630feea43bdaa85dcMike Lockwood return desc->bcdUSB; 510f68600abfc7f1e2d64a4737630feea43bdaa85dcMike Lockwood} 511f68600abfc7f1e2d64a4737630feea43bdaa85dcMike Lockwood 512dfd21b89f28bd8a6d4acdc05b74fbd03bb844f48Vitalii Tomkivchar* usb_device_get_serial(struct usb_device *device, int timeout) 51330ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood{ 51430ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood struct usb_device_descriptor *desc = (struct usb_device_descriptor *)device->desc; 515dfd21b89f28bd8a6d4acdc05b74fbd03bb844f48Vitalii Tomkiv return usb_device_get_string(device, desc->iSerialNumber, timeout); 51630ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood} 51730ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 51830ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwoodint usb_device_is_writeable(struct usb_device *device) 51930ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood{ 52030ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood return device->writeable; 52130ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood} 52230ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 52330ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwoodvoid usb_descriptor_iter_init(struct usb_device *device, struct usb_descriptor_iter *iter) 52430ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood{ 52530ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood iter->config = device->desc; 52630ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood iter->config_end = device->desc + device->desc_length; 52730ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood iter->curr_desc = device->desc; 52830ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood} 52930ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 53030ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwoodstruct usb_descriptor_header *usb_descriptor_iter_next(struct usb_descriptor_iter *iter) 53130ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood{ 53230ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood struct usb_descriptor_header* next; 53330ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood if (iter->curr_desc >= iter->config_end) 53430ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood return NULL; 53530ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood next = (struct usb_descriptor_header*)iter->curr_desc; 53630ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood iter->curr_desc += next->bLength; 53730ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood return next; 53830ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood} 53930ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 54030ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwoodint usb_device_claim_interface(struct usb_device *device, unsigned int interface) 54130ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood{ 54230ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood return ioctl(device->fd, USBDEVFS_CLAIMINTERFACE, &interface); 54330ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood} 54430ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 54530ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwoodint usb_device_release_interface(struct usb_device *device, unsigned int interface) 54630ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood{ 54730ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood return ioctl(device->fd, USBDEVFS_RELEASEINTERFACE, &interface); 54830ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood} 54930ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 550ec9e7b1c1844e66c39a4f63ded8208c1717380f8Mike Lockwoodint usb_device_connect_kernel_driver(struct usb_device *device, 551ec9e7b1c1844e66c39a4f63ded8208c1717380f8Mike Lockwood unsigned int interface, int connect) 552ec9e7b1c1844e66c39a4f63ded8208c1717380f8Mike Lockwood{ 553ec9e7b1c1844e66c39a4f63ded8208c1717380f8Mike Lockwood struct usbdevfs_ioctl ctl; 554ec9e7b1c1844e66c39a4f63ded8208c1717380f8Mike Lockwood 555ec9e7b1c1844e66c39a4f63ded8208c1717380f8Mike Lockwood ctl.ifno = interface; 556ec9e7b1c1844e66c39a4f63ded8208c1717380f8Mike Lockwood ctl.ioctl_code = (connect ? USBDEVFS_CONNECT : USBDEVFS_DISCONNECT); 557ec9e7b1c1844e66c39a4f63ded8208c1717380f8Mike Lockwood ctl.data = NULL; 558ec9e7b1c1844e66c39a4f63ded8208c1717380f8Mike Lockwood return ioctl(device->fd, USBDEVFS_IOCTL, &ctl); 559ec9e7b1c1844e66c39a4f63ded8208c1717380f8Mike Lockwood} 560ec9e7b1c1844e66c39a4f63ded8208c1717380f8Mike Lockwood 561d2e798b53039f35967705acd5f6c399742f97e72Mike Lockwoodint usb_device_set_configuration(struct usb_device *device, int configuration) 562d2e798b53039f35967705acd5f6c399742f97e72Mike Lockwood{ 563d2e798b53039f35967705acd5f6c399742f97e72Mike Lockwood return ioctl(device->fd, USBDEVFS_SETCONFIGURATION, &configuration); 564d2e798b53039f35967705acd5f6c399742f97e72Mike Lockwood} 565d2e798b53039f35967705acd5f6c399742f97e72Mike Lockwood 566d2e798b53039f35967705acd5f6c399742f97e72Mike Lockwoodint usb_device_set_interface(struct usb_device *device, unsigned int interface, 567d2e798b53039f35967705acd5f6c399742f97e72Mike Lockwood unsigned int alt_setting) 568d2e798b53039f35967705acd5f6c399742f97e72Mike Lockwood{ 569d2e798b53039f35967705acd5f6c399742f97e72Mike Lockwood struct usbdevfs_setinterface ctl; 570d2e798b53039f35967705acd5f6c399742f97e72Mike Lockwood 571d2e798b53039f35967705acd5f6c399742f97e72Mike Lockwood ctl.interface = interface; 572d2e798b53039f35967705acd5f6c399742f97e72Mike Lockwood ctl.altsetting = alt_setting; 573d2e798b53039f35967705acd5f6c399742f97e72Mike Lockwood return ioctl(device->fd, USBDEVFS_SETINTERFACE, &ctl); 574d2e798b53039f35967705acd5f6c399742f97e72Mike Lockwood} 575d2e798b53039f35967705acd5f6c399742f97e72Mike Lockwood 576120b57a3d9703bccba534af335aa94dd3a41be2fMike Lockwoodint usb_device_control_transfer(struct usb_device *device, 577120b57a3d9703bccba534af335aa94dd3a41be2fMike Lockwood int requestType, 578120b57a3d9703bccba534af335aa94dd3a41be2fMike Lockwood int request, 579120b57a3d9703bccba534af335aa94dd3a41be2fMike Lockwood int value, 580120b57a3d9703bccba534af335aa94dd3a41be2fMike Lockwood int index, 581120b57a3d9703bccba534af335aa94dd3a41be2fMike Lockwood void* buffer, 582120b57a3d9703bccba534af335aa94dd3a41be2fMike Lockwood int length, 583120b57a3d9703bccba534af335aa94dd3a41be2fMike Lockwood unsigned int timeout) 584120b57a3d9703bccba534af335aa94dd3a41be2fMike Lockwood{ 585120b57a3d9703bccba534af335aa94dd3a41be2fMike Lockwood struct usbdevfs_ctrltransfer ctrl; 586120b57a3d9703bccba534af335aa94dd3a41be2fMike Lockwood 587120b57a3d9703bccba534af335aa94dd3a41be2fMike Lockwood // this usually requires read/write permission 588120b57a3d9703bccba534af335aa94dd3a41be2fMike Lockwood if (!usb_device_reopen_writeable(device)) 589120b57a3d9703bccba534af335aa94dd3a41be2fMike Lockwood return -1; 590120b57a3d9703bccba534af335aa94dd3a41be2fMike Lockwood 591120b57a3d9703bccba534af335aa94dd3a41be2fMike Lockwood memset(&ctrl, 0, sizeof(ctrl)); 592120b57a3d9703bccba534af335aa94dd3a41be2fMike Lockwood ctrl.bRequestType = requestType; 593120b57a3d9703bccba534af335aa94dd3a41be2fMike Lockwood ctrl.bRequest = request; 594120b57a3d9703bccba534af335aa94dd3a41be2fMike Lockwood ctrl.wValue = value; 595120b57a3d9703bccba534af335aa94dd3a41be2fMike Lockwood ctrl.wIndex = index; 596120b57a3d9703bccba534af335aa94dd3a41be2fMike Lockwood ctrl.wLength = length; 597120b57a3d9703bccba534af335aa94dd3a41be2fMike Lockwood ctrl.data = buffer; 598120b57a3d9703bccba534af335aa94dd3a41be2fMike Lockwood ctrl.timeout = timeout; 599120b57a3d9703bccba534af335aa94dd3a41be2fMike Lockwood return ioctl(device->fd, USBDEVFS_CONTROL, &ctrl); 600120b57a3d9703bccba534af335aa94dd3a41be2fMike Lockwood} 601120b57a3d9703bccba534af335aa94dd3a41be2fMike Lockwood 602120b57a3d9703bccba534af335aa94dd3a41be2fMike Lockwoodint usb_device_bulk_transfer(struct usb_device *device, 603120b57a3d9703bccba534af335aa94dd3a41be2fMike Lockwood int endpoint, 604120b57a3d9703bccba534af335aa94dd3a41be2fMike Lockwood void* buffer, 6059879bb2ba28891cb2a4231c39ea2d5d2da730be7Philip P. Moltmann unsigned int length, 606120b57a3d9703bccba534af335aa94dd3a41be2fMike Lockwood unsigned int timeout) 607120b57a3d9703bccba534af335aa94dd3a41be2fMike Lockwood{ 608120b57a3d9703bccba534af335aa94dd3a41be2fMike Lockwood struct usbdevfs_bulktransfer ctrl; 609120b57a3d9703bccba534af335aa94dd3a41be2fMike Lockwood 610c4c00d8e6a215020be87f6702844267e105e1f0eMike Lockwood // need to limit request size to avoid EINVAL 611c4c00d8e6a215020be87f6702844267e105e1f0eMike Lockwood if (length > MAX_USBFS_BUFFER_SIZE) 612c4c00d8e6a215020be87f6702844267e105e1f0eMike Lockwood length = MAX_USBFS_BUFFER_SIZE; 613c4c00d8e6a215020be87f6702844267e105e1f0eMike Lockwood 614120b57a3d9703bccba534af335aa94dd3a41be2fMike Lockwood memset(&ctrl, 0, sizeof(ctrl)); 615120b57a3d9703bccba534af335aa94dd3a41be2fMike Lockwood ctrl.ep = endpoint; 616120b57a3d9703bccba534af335aa94dd3a41be2fMike Lockwood ctrl.len = length; 617120b57a3d9703bccba534af335aa94dd3a41be2fMike Lockwood ctrl.data = buffer; 618120b57a3d9703bccba534af335aa94dd3a41be2fMike Lockwood ctrl.timeout = timeout; 619120b57a3d9703bccba534af335aa94dd3a41be2fMike Lockwood return ioctl(device->fd, USBDEVFS_BULK, &ctrl); 620120b57a3d9703bccba534af335aa94dd3a41be2fMike Lockwood} 621120b57a3d9703bccba534af335aa94dd3a41be2fMike Lockwood 622f6411fa1ecf3a87ce78800660752f57ba9b67836Keun-young Parkint usb_device_reset(struct usb_device *device) 623f6411fa1ecf3a87ce78800660752f57ba9b67836Keun-young Park{ 624f6411fa1ecf3a87ce78800660752f57ba9b67836Keun-young Park return ioctl(device->fd, USBDEVFS_RESET); 625f6411fa1ecf3a87ce78800660752f57ba9b67836Keun-young Park} 626f6411fa1ecf3a87ce78800660752f57ba9b67836Keun-young Park 627e533c5f1005e8913f577d2aeac5a26f88f55a249Mike Lockwoodstruct usb_request *usb_request_new(struct usb_device *dev, 628e533c5f1005e8913f577d2aeac5a26f88f55a249Mike Lockwood const struct usb_endpoint_descriptor *ep_desc) 62930ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood{ 630e533c5f1005e8913f577d2aeac5a26f88f55a249Mike Lockwood struct usbdevfs_urb *urb = calloc(1, sizeof(struct usbdevfs_urb)); 631e533c5f1005e8913f577d2aeac5a26f88f55a249Mike Lockwood if (!urb) 632e533c5f1005e8913f577d2aeac5a26f88f55a249Mike Lockwood return NULL; 633e533c5f1005e8913f577d2aeac5a26f88f55a249Mike Lockwood 634e533c5f1005e8913f577d2aeac5a26f88f55a249Mike Lockwood if ((ep_desc->bmAttributes & USB_ENDPOINT_XFERTYPE_MASK) == USB_ENDPOINT_XFER_BULK) 635e533c5f1005e8913f577d2aeac5a26f88f55a249Mike Lockwood urb->type = USBDEVFS_URB_TYPE_BULK; 636e533c5f1005e8913f577d2aeac5a26f88f55a249Mike Lockwood else if ((ep_desc->bmAttributes & USB_ENDPOINT_XFERTYPE_MASK) == USB_ENDPOINT_XFER_INT) 637e533c5f1005e8913f577d2aeac5a26f88f55a249Mike Lockwood urb->type = USBDEVFS_URB_TYPE_INTERRUPT; 638e533c5f1005e8913f577d2aeac5a26f88f55a249Mike Lockwood else { 639e533c5f1005e8913f577d2aeac5a26f88f55a249Mike Lockwood D("Unsupported endpoint type %d", ep_desc->bmAttributes & USB_ENDPOINT_XFERTYPE_MASK); 640e533c5f1005e8913f577d2aeac5a26f88f55a249Mike Lockwood free(urb); 641e533c5f1005e8913f577d2aeac5a26f88f55a249Mike Lockwood return NULL; 642e533c5f1005e8913f577d2aeac5a26f88f55a249Mike Lockwood } 643e533c5f1005e8913f577d2aeac5a26f88f55a249Mike Lockwood urb->endpoint = ep_desc->bEndpointAddress; 644e533c5f1005e8913f577d2aeac5a26f88f55a249Mike Lockwood 645e533c5f1005e8913f577d2aeac5a26f88f55a249Mike Lockwood struct usb_request *req = calloc(1, sizeof(struct usb_request)); 646e533c5f1005e8913f577d2aeac5a26f88f55a249Mike Lockwood if (!req) { 647e533c5f1005e8913f577d2aeac5a26f88f55a249Mike Lockwood free(urb); 648e533c5f1005e8913f577d2aeac5a26f88f55a249Mike Lockwood return NULL; 649e533c5f1005e8913f577d2aeac5a26f88f55a249Mike Lockwood } 650e533c5f1005e8913f577d2aeac5a26f88f55a249Mike Lockwood 651e533c5f1005e8913f577d2aeac5a26f88f55a249Mike Lockwood req->dev = dev; 652e533c5f1005e8913f577d2aeac5a26f88f55a249Mike Lockwood req->max_packet_size = __le16_to_cpu(ep_desc->wMaxPacketSize); 653e533c5f1005e8913f577d2aeac5a26f88f55a249Mike Lockwood req->private_data = urb; 654b5d68a3c28d0b7a947373344cbda2a2369d0b67dMike Lockwood req->endpoint = urb->endpoint; 655e533c5f1005e8913f577d2aeac5a26f88f55a249Mike Lockwood urb->usercontext = req; 656e533c5f1005e8913f577d2aeac5a26f88f55a249Mike Lockwood 657e533c5f1005e8913f577d2aeac5a26f88f55a249Mike Lockwood return req; 65830ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood} 65930ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 660e533c5f1005e8913f577d2aeac5a26f88f55a249Mike Lockwoodvoid usb_request_free(struct usb_request *req) 66130ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood{ 662e533c5f1005e8913f577d2aeac5a26f88f55a249Mike Lockwood free(req->private_data); 663e533c5f1005e8913f577d2aeac5a26f88f55a249Mike Lockwood free(req); 66430ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood} 66530ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 666e533c5f1005e8913f577d2aeac5a26f88f55a249Mike Lockwoodint usb_request_queue(struct usb_request *req) 66730ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood{ 668e533c5f1005e8913f577d2aeac5a26f88f55a249Mike Lockwood struct usbdevfs_urb *urb = (struct usbdevfs_urb*)req->private_data; 66930ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood int res; 67030ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 67130ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood urb->status = -1; 672e533c5f1005e8913f577d2aeac5a26f88f55a249Mike Lockwood urb->buffer = req->buffer; 673c4c00d8e6a215020be87f6702844267e105e1f0eMike Lockwood // need to limit request size to avoid EINVAL 674c4c00d8e6a215020be87f6702844267e105e1f0eMike Lockwood if (req->buffer_length > MAX_USBFS_BUFFER_SIZE) 675c4c00d8e6a215020be87f6702844267e105e1f0eMike Lockwood urb->buffer_length = MAX_USBFS_BUFFER_SIZE; 676c4c00d8e6a215020be87f6702844267e105e1f0eMike Lockwood else 677c4c00d8e6a215020be87f6702844267e105e1f0eMike Lockwood urb->buffer_length = req->buffer_length; 67830ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 67930ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood do { 680e533c5f1005e8913f577d2aeac5a26f88f55a249Mike Lockwood res = ioctl(req->dev->fd, USBDEVFS_SUBMITURB, urb); 68130ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood } while((res < 0) && (errno == EINTR)); 68230ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 68330ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood return res; 68430ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood} 68530ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 686e533c5f1005e8913f577d2aeac5a26f88f55a249Mike Lockwoodstruct usb_request *usb_request_wait(struct usb_device *dev) 68730ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood{ 688e533c5f1005e8913f577d2aeac5a26f88f55a249Mike Lockwood struct usbdevfs_urb *urb = NULL; 689e533c5f1005e8913f577d2aeac5a26f88f55a249Mike Lockwood struct usb_request *req = NULL; 69030ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 69130ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood while (1) { 692e533c5f1005e8913f577d2aeac5a26f88f55a249Mike Lockwood int res = ioctl(dev->fd, USBDEVFS_REAPURB, &urb); 69330ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood D("USBDEVFS_REAPURB returned %d\n", res); 69430ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood if (res < 0) { 69530ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood if(errno == EINTR) { 69630ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood continue; 69730ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood } 69830ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood D("[ reap urb - error ]\n"); 699e533c5f1005e8913f577d2aeac5a26f88f55a249Mike Lockwood return NULL; 70030ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood } else { 70130ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood D("[ urb @%p status = %d, actual = %d ]\n", 702e533c5f1005e8913f577d2aeac5a26f88f55a249Mike Lockwood urb, urb->status, urb->actual_length); 703e533c5f1005e8913f577d2aeac5a26f88f55a249Mike Lockwood req = (struct usb_request*)urb->usercontext; 704e533c5f1005e8913f577d2aeac5a26f88f55a249Mike Lockwood req->actual_length = urb->actual_length; 70530ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood } 70630ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood break; 70730ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood } 708e533c5f1005e8913f577d2aeac5a26f88f55a249Mike Lockwood return req; 70930ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood} 71030ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood 711e533c5f1005e8913f577d2aeac5a26f88f55a249Mike Lockwoodint usb_request_cancel(struct usb_request *req) 71230ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood{ 713e533c5f1005e8913f577d2aeac5a26f88f55a249Mike Lockwood struct usbdevfs_urb *urb = ((struct usbdevfs_urb*)req->private_data); 714ef4087bf2b20dfa44c7e33c1544d29cfdcd656e7Badhri Jagan Sridharan return ioctl(req->dev->fd, USBDEVFS_DISCARDURB, urb); 71530ff2c70ce05d761e8cb0ab7ee02b39a681fe0cbMike Lockwood} 716