1dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project/* 2dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project * Copyright (C) 2007 The Android Open Source Project 3dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project * 4dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project * Licensed under the Apache License, Version 2.0 (the "License"); 5dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project * you may not use this file except in compliance with the License. 6dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project * You may obtain a copy of the License at 7dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project * 8dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project * http://www.apache.org/licenses/LICENSE-2.0 9dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project * 10dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project * Unless required by applicable law or agreed to in writing, software 11dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project * distributed under the License is distributed on an "AS IS" BASIS, 12dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. 13dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project * See the License for the specific language governing permissions and 14dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project * limitations under the License. 15dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project */ 16dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 17dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project#include <stdio.h> 18dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project#include <stdlib.h> 19dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project#include <unistd.h> 20dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project#include <string.h> 21dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 22dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project#include <sys/ioctl.h> 23dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project#include <sys/types.h> 24fe582b5d32d08d075be87f4c9193e24029963361Mike Lockwood#include <sys/time.h> 25dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project#include <dirent.h> 26dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project#include <fcntl.h> 27dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project#include <errno.h> 28dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project#include <ctype.h> 29dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 30dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project#include <linux/usbdevice_fs.h> 31dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project#include <linux/version.h> 32dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project#if LINUX_VERSION_CODE > KERNEL_VERSION(2, 6, 20) 33dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project#include <linux/usb/ch9.h> 34dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project#else 35dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project#include <linux/usb_ch9.h> 36dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project#endif 37dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project#include <asm/byteorder.h> 38dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 39dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project#include "sysdeps.h" 40dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 41dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project#define TRACE_TAG TRACE_USB 42dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project#include "adb.h" 43dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 44dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 45dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project/* usb scan debugging is waaaay too verbose */ 46dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project#define DBGX(x...) 47dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 48dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Projectstatic adb_mutex_t usb_lock = ADB_MUTEX_INITIALIZER; 49dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 50dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Projectstruct usb_handle 51dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project{ 52dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project usb_handle *prev; 53dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project usb_handle *next; 54dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 55dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project char fname[64]; 56dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project int desc; 57dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project unsigned char ep_in; 58dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project unsigned char ep_out; 59dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 60dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project unsigned zero_mask; 610927bf9690127bc45cf8837a1467759e9720399aMike Lockwood unsigned writeable; 62dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 63dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project struct usbdevfs_urb urb_in; 64dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project struct usbdevfs_urb urb_out; 65dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 66dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project int urb_in_busy; 67dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project int urb_out_busy; 68dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project int dead; 69dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 70dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project adb_cond_t notify; 71dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project adb_mutex_t lock; 72dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 73dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project // for garbage collecting disconnected devices 74dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project int mark; 75dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 76dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project // ID of thread currently in REAPURB 77dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project pthread_t reaper_thread; 78dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project}; 79dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 80dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Projectstatic usb_handle handle_list = { 81dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project .prev = &handle_list, 82dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project .next = &handle_list, 83dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project}; 84dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 85dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Projectstatic int known_device(const char *dev_name) 86dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project{ 87dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project usb_handle *usb; 88dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 89dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project adb_mutex_lock(&usb_lock); 90dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project for(usb = handle_list.next; usb != &handle_list; usb = usb->next){ 91dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project if(!strcmp(usb->fname, dev_name)) { 92dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project // set mark flag to indicate this device is still alive 93dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project usb->mark = 1; 94dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project adb_mutex_unlock(&usb_lock); 95dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project return 1; 96dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project } 97dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project } 98dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project adb_mutex_unlock(&usb_lock); 99dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project return 0; 100dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project} 101dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 102dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Projectstatic void kick_disconnected_devices() 103dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project{ 104dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project usb_handle *usb; 105dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 106dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project adb_mutex_lock(&usb_lock); 107dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project // kick any devices in the device list that were not found in the device scan 108dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project for(usb = handle_list.next; usb != &handle_list; usb = usb->next){ 109dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project if (usb->mark == 0) { 110dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project usb_kick(usb); 111dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project } else { 112dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project usb->mark = 0; 113dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project } 114dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project } 115dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project adb_mutex_unlock(&usb_lock); 116dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 117dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project} 118dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 119dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Projectstatic void register_device(const char *dev_name, unsigned char ep_in, unsigned char ep_out, 1200927bf9690127bc45cf8837a1467759e9720399aMike Lockwood int ifc, int serial_index, unsigned zero_mask); 121dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 122dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Projectstatic inline int badname(const char *name) 123dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project{ 124dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project while(*name) { 125dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project if(!isdigit(*name++)) return 1; 126dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project } 127dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project return 0; 128dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project} 129dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 1300927bf9690127bc45cf8837a1467759e9720399aMike Lockwoodstatic void find_usb_device(const char *base, 1310927bf9690127bc45cf8837a1467759e9720399aMike Lockwood void (*register_device_callback) 1320927bf9690127bc45cf8837a1467759e9720399aMike Lockwood (const char *, unsigned char, unsigned char, int, int, unsigned)) 133dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project{ 134dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project char busname[32], devname[32]; 135dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project unsigned char local_ep_in, local_ep_out; 136dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project DIR *busdir , *devdir ; 137dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project struct dirent *de; 138dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project int fd ; 139dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 140dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project busdir = opendir(base); 1410927bf9690127bc45cf8837a1467759e9720399aMike Lockwood if(busdir == 0) return; 142dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 143dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project while((de = readdir(busdir)) != 0) { 144dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project if(badname(de->d_name)) continue; 145dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 146dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project snprintf(busname, sizeof busname, "%s/%s", base, de->d_name); 147dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project devdir = opendir(busname); 148dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project if(devdir == 0) continue; 149dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 150dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project// DBGX("[ scanning %s ]\n", busname); 151dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project while((de = readdir(devdir))) { 152dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project unsigned char devdesc[256]; 153dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project unsigned char* bufptr = devdesc; 15407e8f7e8758d5ce44fe6cf3bacb670962750a92eMike Lockwood unsigned char* bufend; 155dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project struct usb_device_descriptor* device; 156dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project struct usb_config_descriptor* config; 157dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project struct usb_interface_descriptor* interface; 158dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project struct usb_endpoint_descriptor *ep1, *ep2; 159dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project unsigned zero_mask = 0; 160dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project unsigned vid, pid; 161dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project size_t desclength; 162dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 163dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project if(badname(de->d_name)) continue; 164dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project snprintf(devname, sizeof devname, "%s/%s", busname, de->d_name); 165dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 166dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project if(known_device(devname)) { 167dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project DBGX("skipping %s\n", devname); 168dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project continue; 169dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project } 170dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 171dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project// DBGX("[ scanning %s ]\n", devname); 1720927bf9690127bc45cf8837a1467759e9720399aMike Lockwood if((fd = unix_open(devname, O_RDONLY)) < 0) { 173dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project continue; 174dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project } 175dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 176dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project desclength = adb_read(fd, devdesc, sizeof(devdesc)); 17707e8f7e8758d5ce44fe6cf3bacb670962750a92eMike Lockwood bufend = bufptr + desclength; 178dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 179dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project // should have device and configuration descriptors, and atleast two endpoints 180dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project if (desclength < USB_DT_DEVICE_SIZE + USB_DT_CONFIG_SIZE) { 181dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project D("desclength %d is too small\n", desclength); 182dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project adb_close(fd); 183dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project continue; 184dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project } 185dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 186dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project device = (struct usb_device_descriptor*)bufptr; 187dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project bufptr += USB_DT_DEVICE_SIZE; 188dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 189dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project if((device->bLength != USB_DT_DEVICE_SIZE) || (device->bDescriptorType != USB_DT_DEVICE)) { 190dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project adb_close(fd); 191dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project continue; 192dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project } 193dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 194dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project vid = __le16_to_cpu(device->idVendor); 195dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project pid = __le16_to_cpu(device->idProduct); 196dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project pid = devdesc[10] | (devdesc[11] << 8); 197dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project DBGX("[ %s is V:%04x P:%04x ]\n", devname, vid, pid); 198dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 199dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project // should have config descriptor next 200dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project config = (struct usb_config_descriptor *)bufptr; 201dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project bufptr += USB_DT_CONFIG_SIZE; 202dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project if (config->bLength != USB_DT_CONFIG_SIZE || config->bDescriptorType != USB_DT_CONFIG) { 203dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project D("usb_config_descriptor not found\n"); 204dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project adb_close(fd); 205dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project continue; 206dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project } 207dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 20807e8f7e8758d5ce44fe6cf3bacb670962750a92eMike Lockwood // loop through all the descriptors and look for the ADB interface 20907e8f7e8758d5ce44fe6cf3bacb670962750a92eMike Lockwood while (bufptr < bufend) { 21007e8f7e8758d5ce44fe6cf3bacb670962750a92eMike Lockwood unsigned char length = bufptr[0]; 21107e8f7e8758d5ce44fe6cf3bacb670962750a92eMike Lockwood unsigned char type = bufptr[1]; 212dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 21307e8f7e8758d5ce44fe6cf3bacb670962750a92eMike Lockwood if (type == USB_DT_INTERFACE) { 21407e8f7e8758d5ce44fe6cf3bacb670962750a92eMike Lockwood interface = (struct usb_interface_descriptor *)bufptr; 21507e8f7e8758d5ce44fe6cf3bacb670962750a92eMike Lockwood bufptr += length; 216dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 21707e8f7e8758d5ce44fe6cf3bacb670962750a92eMike Lockwood if (length != USB_DT_INTERFACE_SIZE) { 21807e8f7e8758d5ce44fe6cf3bacb670962750a92eMike Lockwood D("interface descriptor has wrong size\n"); 21907e8f7e8758d5ce44fe6cf3bacb670962750a92eMike Lockwood break; 220dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project } 221dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 22207e8f7e8758d5ce44fe6cf3bacb670962750a92eMike Lockwood DBGX("bInterfaceClass: %d, bInterfaceSubClass: %d," 22307e8f7e8758d5ce44fe6cf3bacb670962750a92eMike Lockwood "bInterfaceProtocol: %d, bNumEndpoints: %d\n", 22407e8f7e8758d5ce44fe6cf3bacb670962750a92eMike Lockwood interface->bInterfaceClass, interface->bInterfaceSubClass, 22507e8f7e8758d5ce44fe6cf3bacb670962750a92eMike Lockwood interface->bInterfaceProtocol, interface->bNumEndpoints); 22607e8f7e8758d5ce44fe6cf3bacb670962750a92eMike Lockwood 22707e8f7e8758d5ce44fe6cf3bacb670962750a92eMike Lockwood if (interface->bNumEndpoints == 2 && 22807e8f7e8758d5ce44fe6cf3bacb670962750a92eMike Lockwood is_adb_interface(vid, pid, interface->bInterfaceClass, 22907e8f7e8758d5ce44fe6cf3bacb670962750a92eMike Lockwood interface->bInterfaceSubClass, interface->bInterfaceProtocol)) { 23007e8f7e8758d5ce44fe6cf3bacb670962750a92eMike Lockwood 23107e8f7e8758d5ce44fe6cf3bacb670962750a92eMike Lockwood DBGX("looking for bulk endpoints\n"); 23207e8f7e8758d5ce44fe6cf3bacb670962750a92eMike Lockwood // looks like ADB... 23307e8f7e8758d5ce44fe6cf3bacb670962750a92eMike Lockwood ep1 = (struct usb_endpoint_descriptor *)bufptr; 23407e8f7e8758d5ce44fe6cf3bacb670962750a92eMike Lockwood bufptr += USB_DT_ENDPOINT_SIZE; 23507e8f7e8758d5ce44fe6cf3bacb670962750a92eMike Lockwood ep2 = (struct usb_endpoint_descriptor *)bufptr; 23607e8f7e8758d5ce44fe6cf3bacb670962750a92eMike Lockwood bufptr += USB_DT_ENDPOINT_SIZE; 23707e8f7e8758d5ce44fe6cf3bacb670962750a92eMike Lockwood 23807e8f7e8758d5ce44fe6cf3bacb670962750a92eMike Lockwood if (bufptr > devdesc + desclength || 23907e8f7e8758d5ce44fe6cf3bacb670962750a92eMike Lockwood ep1->bLength != USB_DT_ENDPOINT_SIZE || 24007e8f7e8758d5ce44fe6cf3bacb670962750a92eMike Lockwood ep1->bDescriptorType != USB_DT_ENDPOINT || 24107e8f7e8758d5ce44fe6cf3bacb670962750a92eMike Lockwood ep2->bLength != USB_DT_ENDPOINT_SIZE || 24207e8f7e8758d5ce44fe6cf3bacb670962750a92eMike Lockwood ep2->bDescriptorType != USB_DT_ENDPOINT) { 24307e8f7e8758d5ce44fe6cf3bacb670962750a92eMike Lockwood D("endpoints not found\n"); 24407e8f7e8758d5ce44fe6cf3bacb670962750a92eMike Lockwood break; 24507e8f7e8758d5ce44fe6cf3bacb670962750a92eMike Lockwood } 24607e8f7e8758d5ce44fe6cf3bacb670962750a92eMike Lockwood 24707e8f7e8758d5ce44fe6cf3bacb670962750a92eMike Lockwood // both endpoints should be bulk 24807e8f7e8758d5ce44fe6cf3bacb670962750a92eMike Lockwood if (ep1->bmAttributes != USB_ENDPOINT_XFER_BULK || 24907e8f7e8758d5ce44fe6cf3bacb670962750a92eMike Lockwood ep2->bmAttributes != USB_ENDPOINT_XFER_BULK) { 25007e8f7e8758d5ce44fe6cf3bacb670962750a92eMike Lockwood D("bulk endpoints not found\n"); 25107e8f7e8758d5ce44fe6cf3bacb670962750a92eMike Lockwood continue; 25207e8f7e8758d5ce44fe6cf3bacb670962750a92eMike Lockwood } 25307e8f7e8758d5ce44fe6cf3bacb670962750a92eMike Lockwood /* aproto 01 needs 0 termination */ 25407e8f7e8758d5ce44fe6cf3bacb670962750a92eMike Lockwood if(interface->bInterfaceProtocol == 0x01) { 25507e8f7e8758d5ce44fe6cf3bacb670962750a92eMike Lockwood zero_mask = ep1->wMaxPacketSize - 1; 25607e8f7e8758d5ce44fe6cf3bacb670962750a92eMike Lockwood } 25707e8f7e8758d5ce44fe6cf3bacb670962750a92eMike Lockwood 25807e8f7e8758d5ce44fe6cf3bacb670962750a92eMike Lockwood // we have a match. now we just need to figure out which is in and which is out. 25907e8f7e8758d5ce44fe6cf3bacb670962750a92eMike Lockwood if (ep1->bEndpointAddress & USB_ENDPOINT_DIR_MASK) { 26007e8f7e8758d5ce44fe6cf3bacb670962750a92eMike Lockwood local_ep_in = ep1->bEndpointAddress; 26107e8f7e8758d5ce44fe6cf3bacb670962750a92eMike Lockwood local_ep_out = ep2->bEndpointAddress; 26207e8f7e8758d5ce44fe6cf3bacb670962750a92eMike Lockwood } else { 26307e8f7e8758d5ce44fe6cf3bacb670962750a92eMike Lockwood local_ep_in = ep2->bEndpointAddress; 26407e8f7e8758d5ce44fe6cf3bacb670962750a92eMike Lockwood local_ep_out = ep1->bEndpointAddress; 26507e8f7e8758d5ce44fe6cf3bacb670962750a92eMike Lockwood } 26607e8f7e8758d5ce44fe6cf3bacb670962750a92eMike Lockwood 26707e8f7e8758d5ce44fe6cf3bacb670962750a92eMike Lockwood register_device_callback(devname, local_ep_in, local_ep_out, 26807e8f7e8758d5ce44fe6cf3bacb670962750a92eMike Lockwood interface->bInterfaceNumber, device->iSerialNumber, zero_mask); 26907e8f7e8758d5ce44fe6cf3bacb670962750a92eMike Lockwood break; 270dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project } 271dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project } else { 27207e8f7e8758d5ce44fe6cf3bacb670962750a92eMike Lockwood bufptr += length; 27307e8f7e8758d5ce44fe6cf3bacb670962750a92eMike Lockwood } 27407e8f7e8758d5ce44fe6cf3bacb670962750a92eMike Lockwood } // end of while 275dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 276dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project adb_close(fd); 277dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project } // end of devdir while 278dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project closedir(devdir); 279dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project } //end of busdir while 280dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project closedir(busdir); 281dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project} 282dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 283dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Projectvoid usb_cleanup() 284dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project{ 285dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project} 286dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 287dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Projectstatic int usb_bulk_write(usb_handle *h, const void *data, int len) 288dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project{ 289dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project struct usbdevfs_urb *urb = &h->urb_out; 290dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project int res; 291fe582b5d32d08d075be87f4c9193e24029963361Mike Lockwood struct timeval tv; 292fe582b5d32d08d075be87f4c9193e24029963361Mike Lockwood struct timespec ts; 293dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 294dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project memset(urb, 0, sizeof(*urb)); 295dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project urb->type = USBDEVFS_URB_TYPE_BULK; 296dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project urb->endpoint = h->ep_out; 297dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project urb->status = -1; 298dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project urb->buffer = (void*) data; 299dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project urb->buffer_length = len; 300dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 301dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project D("++ write ++\n"); 302dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 303dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project adb_mutex_lock(&h->lock); 304dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project if(h->dead) { 305dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project res = -1; 306dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project goto fail; 307dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project } 308dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project do { 309dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project res = ioctl(h->desc, USBDEVFS_SUBMITURB, urb); 310dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project } while((res < 0) && (errno == EINTR)); 311dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 312dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project if(res < 0) { 313dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project goto fail; 314dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project } 315dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 316dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project res = -1; 317dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project h->urb_out_busy = 1; 318dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project for(;;) { 319fe582b5d32d08d075be87f4c9193e24029963361Mike Lockwood /* time out after five seconds */ 320fe582b5d32d08d075be87f4c9193e24029963361Mike Lockwood gettimeofday(&tv, NULL); 321fe582b5d32d08d075be87f4c9193e24029963361Mike Lockwood ts.tv_sec = tv.tv_sec + 5; 322fe582b5d32d08d075be87f4c9193e24029963361Mike Lockwood ts.tv_nsec = tv.tv_usec * 1000L; 323fe582b5d32d08d075be87f4c9193e24029963361Mike Lockwood res = pthread_cond_timedwait(&h->notify, &h->lock, &ts); 324fe582b5d32d08d075be87f4c9193e24029963361Mike Lockwood if(res < 0 || h->dead) { 325dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project break; 326dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project } 327dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project if(h->urb_out_busy == 0) { 328dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project if(urb->status == 0) { 329dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project res = urb->actual_length; 330dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project } 331dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project break; 332dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project } 333dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project } 334dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Projectfail: 335dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project adb_mutex_unlock(&h->lock); 336dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project D("-- write --\n"); 337dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project return res; 338dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project} 339dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 340dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Projectstatic int usb_bulk_read(usb_handle *h, void *data, int len) 341dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project{ 342dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project struct usbdevfs_urb *urb = &h->urb_in; 343dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project struct usbdevfs_urb *out = NULL; 344dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project int res; 345dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 346dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project memset(urb, 0, sizeof(*urb)); 347dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project urb->type = USBDEVFS_URB_TYPE_BULK; 348dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project urb->endpoint = h->ep_in; 349dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project urb->status = -1; 350dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project urb->buffer = data; 351dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project urb->buffer_length = len; 352dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 353dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 354dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project adb_mutex_lock(&h->lock); 355dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project if(h->dead) { 356dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project res = -1; 357dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project goto fail; 358dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project } 359dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project do { 360dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project res = ioctl(h->desc, USBDEVFS_SUBMITURB, urb); 361dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project } while((res < 0) && (errno == EINTR)); 362dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 363dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project if(res < 0) { 364dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project goto fail; 365dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project } 366dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 367dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project h->urb_in_busy = 1; 368dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project for(;;) { 369dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project D("[ reap urb - wait ]\n"); 370dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project h->reaper_thread = pthread_self(); 371dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project adb_mutex_unlock(&h->lock); 372dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project res = ioctl(h->desc, USBDEVFS_REAPURB, &out); 373dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project adb_mutex_lock(&h->lock); 374dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project h->reaper_thread = 0; 375dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project if(h->dead) { 376dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project res = -1; 377dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project break; 378dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project } 379dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project if(res < 0) { 380dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project if(errno == EINTR) { 381dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project continue; 382dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project } 383dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project D("[ reap urb - error ]\n"); 384dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project break; 385dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project } 386dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project D("[ urb @%p status = %d, actual = %d ]\n", 387dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project out, out->status, out->actual_length); 388dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 389dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project if(out == &h->urb_in) { 390dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project D("[ reap urb - IN complete ]\n"); 391dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project h->urb_in_busy = 0; 392dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project if(urb->status == 0) { 393dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project res = urb->actual_length; 394dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project } else { 395dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project res = -1; 396dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project } 397dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project break; 398dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project } 399dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project if(out == &h->urb_out) { 400dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project D("[ reap urb - OUT compelete ]\n"); 401dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project h->urb_out_busy = 0; 402dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project adb_cond_broadcast(&h->notify); 403dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project } 404dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project } 405dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Projectfail: 406dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project adb_mutex_unlock(&h->lock); 407dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project return res; 408dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project} 409dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 410dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 411dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Projectint usb_write(usb_handle *h, const void *_data, int len) 412dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project{ 413dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project unsigned char *data = (unsigned char*) _data; 414dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project int n; 415dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project int need_zero = 0; 416dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 417dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project if(h->zero_mask) { 418dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project /* if we need 0-markers and our transfer 419dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project ** is an even multiple of the packet size, 420dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project ** we make note of it 421dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project */ 422dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project if(!(len & h->zero_mask)) { 423dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project need_zero = 1; 424dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project } 425dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project } 426dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 427dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project while(len > 0) { 428dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project int xfer = (len > 4096) ? 4096 : len; 429dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 430dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project n = usb_bulk_write(h, data, xfer); 431dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project if(n != xfer) { 432dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project D("ERROR: n = %d, errno = %d (%s)\n", 433dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project n, errno, strerror(errno)); 434dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project return -1; 435dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project } 436dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 437dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project len -= xfer; 438dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project data += xfer; 439dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project } 440dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 441dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project if(need_zero){ 442dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project n = usb_bulk_write(h, _data, 0); 443dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project return n; 444dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project } 445dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 446dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project return 0; 447dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project} 448dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 449dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Projectint usb_read(usb_handle *h, void *_data, int len) 450dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project{ 451dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project unsigned char *data = (unsigned char*) _data; 452dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project int n; 453dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 454dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project D("++ usb_read ++\n"); 455dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project while(len > 0) { 456dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project int xfer = (len > 4096) ? 4096 : len; 457dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 458dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project D("[ usb read %d fd = %d], fname=%s\n", xfer, h->desc, h->fname); 459dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project n = usb_bulk_read(h, data, xfer); 460dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project D("[ usb read %d ] = %d, fname=%s\n", xfer, n, h->fname); 461dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project if(n != xfer) { 462dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project if((errno == ETIMEDOUT) && (h->desc != -1)) { 463dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project D("[ timeout ]\n"); 464dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project if(n > 0){ 465dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project data += n; 466dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project len -= n; 467dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project } 468dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project continue; 469dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project } 470dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project D("ERROR: n = %d, errno = %d (%s)\n", 471dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project n, errno, strerror(errno)); 472dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project return -1; 473dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project } 474dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 475dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project len -= xfer; 476dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project data += xfer; 477dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project } 478dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 479dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project D("-- usb_read --\n"); 480dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project return 0; 481dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project} 482dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 483dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Projectvoid usb_kick(usb_handle *h) 484dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project{ 485dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project D("[ kicking %p (fd = %d) ]\n", h, h->desc); 486dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project adb_mutex_lock(&h->lock); 487dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project if(h->dead == 0) { 488dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project h->dead = 1; 489dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 4900927bf9690127bc45cf8837a1467759e9720399aMike Lockwood if (h->writeable) { 4910927bf9690127bc45cf8837a1467759e9720399aMike Lockwood /* HACK ALERT! 4920927bf9690127bc45cf8837a1467759e9720399aMike Lockwood ** Sometimes we get stuck in ioctl(USBDEVFS_REAPURB). 4930927bf9690127bc45cf8837a1467759e9720399aMike Lockwood ** This is a workaround for that problem. 4940927bf9690127bc45cf8837a1467759e9720399aMike Lockwood */ 4950927bf9690127bc45cf8837a1467759e9720399aMike Lockwood if (h->reaper_thread) { 4960927bf9690127bc45cf8837a1467759e9720399aMike Lockwood pthread_kill(h->reaper_thread, SIGALRM); 4970927bf9690127bc45cf8837a1467759e9720399aMike Lockwood } 498dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 4990927bf9690127bc45cf8837a1467759e9720399aMike Lockwood /* cancel any pending transactions 5000927bf9690127bc45cf8837a1467759e9720399aMike Lockwood ** these will quietly fail if the txns are not active, 5010927bf9690127bc45cf8837a1467759e9720399aMike Lockwood ** but this ensures that a reader blocked on REAPURB 5020927bf9690127bc45cf8837a1467759e9720399aMike Lockwood ** will get unblocked 5030927bf9690127bc45cf8837a1467759e9720399aMike Lockwood */ 5040927bf9690127bc45cf8837a1467759e9720399aMike Lockwood ioctl(h->desc, USBDEVFS_DISCARDURB, &h->urb_in); 5050927bf9690127bc45cf8837a1467759e9720399aMike Lockwood ioctl(h->desc, USBDEVFS_DISCARDURB, &h->urb_out); 5060927bf9690127bc45cf8837a1467759e9720399aMike Lockwood h->urb_in.status = -ENODEV; 5070927bf9690127bc45cf8837a1467759e9720399aMike Lockwood h->urb_out.status = -ENODEV; 5080927bf9690127bc45cf8837a1467759e9720399aMike Lockwood h->urb_in_busy = 0; 5090927bf9690127bc45cf8837a1467759e9720399aMike Lockwood h->urb_out_busy = 0; 5100927bf9690127bc45cf8837a1467759e9720399aMike Lockwood adb_cond_broadcast(&h->notify); 5110927bf9690127bc45cf8837a1467759e9720399aMike Lockwood } else { 5120927bf9690127bc45cf8837a1467759e9720399aMike Lockwood unregister_usb_transport(h); 5130927bf9690127bc45cf8837a1467759e9720399aMike Lockwood } 514dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project } 515dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project adb_mutex_unlock(&h->lock); 516dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project} 517dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 518dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Projectint usb_close(usb_handle *h) 519dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project{ 520dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project D("[ usb close ... ]\n"); 521dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project adb_mutex_lock(&usb_lock); 522dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project h->next->prev = h->prev; 523dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project h->prev->next = h->next; 524dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project h->prev = 0; 525dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project h->next = 0; 526dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 527dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project adb_close(h->desc); 528dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project D("[ usb closed %p (fd = %d) ]\n", h, h->desc); 529dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project adb_mutex_unlock(&usb_lock); 530dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 531dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project free(h); 532dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project return 0; 533dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project} 534dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 535dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Projectstatic void register_device(const char *dev_name, 536dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project unsigned char ep_in, unsigned char ep_out, 5370927bf9690127bc45cf8837a1467759e9720399aMike Lockwood int interface, int serial_index, unsigned zero_mask) 538dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project{ 539dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project usb_handle* usb = 0; 540dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project int n = 0; 5410927bf9690127bc45cf8837a1467759e9720399aMike Lockwood char serial[256]; 542dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 543dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project /* Since Linux will not reassign the device ID (and dev_name) 544dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project ** as long as the device is open, we can add to the list here 545dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project ** once we open it and remove from the list when we're finally 546dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project ** closed and everything will work out fine. 547dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project ** 548dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project ** If we have a usb_handle on the list 'o handles with a matching 549dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project ** name, we have no further work to do. 550dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project */ 551dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project adb_mutex_lock(&usb_lock); 552dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project for(usb = handle_list.next; usb != &handle_list; usb = usb->next){ 553dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project if(!strcmp(usb->fname, dev_name)) { 554dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project adb_mutex_unlock(&usb_lock); 555dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project return; 556dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project } 557dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project } 558dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project adb_mutex_unlock(&usb_lock); 559dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 560dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project D("[ usb located new device %s (%d/%d/%d) ]\n", 561dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project dev_name, ep_in, ep_out, interface); 562dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project usb = calloc(1, sizeof(usb_handle)); 563dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project strcpy(usb->fname, dev_name); 564dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project usb->ep_in = ep_in; 565dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project usb->ep_out = ep_out; 566dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project usb->zero_mask = zero_mask; 5670927bf9690127bc45cf8837a1467759e9720399aMike Lockwood usb->writeable = 1; 568dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 569dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project adb_cond_init(&usb->notify, 0); 570dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project adb_mutex_init(&usb->lock, 0); 571dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project /* initialize mark to 1 so we don't get garbage collected after the device scan */ 572dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project usb->mark = 1; 573dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project usb->reaper_thread = 0; 574dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 575dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project usb->desc = unix_open(usb->fname, O_RDWR); 5760927bf9690127bc45cf8837a1467759e9720399aMike Lockwood if(usb->desc < 0) { 5770927bf9690127bc45cf8837a1467759e9720399aMike Lockwood /* if we fail, see if have read-only access */ 5780927bf9690127bc45cf8837a1467759e9720399aMike Lockwood usb->desc = unix_open(usb->fname, O_RDONLY); 5790927bf9690127bc45cf8837a1467759e9720399aMike Lockwood if(usb->desc < 0) goto fail; 5800927bf9690127bc45cf8837a1467759e9720399aMike Lockwood usb->writeable = 0; 5810927bf9690127bc45cf8837a1467759e9720399aMike Lockwood D("[ usb open read-only %s fd = %d]\n", usb->fname, usb->desc); 5820927bf9690127bc45cf8837a1467759e9720399aMike Lockwood } else { 5830927bf9690127bc45cf8837a1467759e9720399aMike Lockwood D("[ usb open %s fd = %d]\n", usb->fname, usb->desc); 5840927bf9690127bc45cf8837a1467759e9720399aMike Lockwood n = ioctl(usb->desc, USBDEVFS_CLAIMINTERFACE, &interface); 5850927bf9690127bc45cf8837a1467759e9720399aMike Lockwood if(n != 0) goto fail; 5860927bf9690127bc45cf8837a1467759e9720399aMike Lockwood } 5870927bf9690127bc45cf8837a1467759e9720399aMike Lockwood 5880927bf9690127bc45cf8837a1467759e9720399aMike Lockwood /* read the device's serial number */ 5890927bf9690127bc45cf8837a1467759e9720399aMike Lockwood serial[0] = 0; 5900927bf9690127bc45cf8837a1467759e9720399aMike Lockwood memset(serial, 0, sizeof(serial)); 5910927bf9690127bc45cf8837a1467759e9720399aMike Lockwood if (serial_index) { 5920927bf9690127bc45cf8837a1467759e9720399aMike Lockwood struct usbdevfs_ctrltransfer ctrl; 5930927bf9690127bc45cf8837a1467759e9720399aMike Lockwood __u16 buffer[128]; 5940927bf9690127bc45cf8837a1467759e9720399aMike Lockwood __u16 languages[128]; 5950927bf9690127bc45cf8837a1467759e9720399aMike Lockwood int i, result; 5960927bf9690127bc45cf8837a1467759e9720399aMike Lockwood int languageCount = 0; 5970927bf9690127bc45cf8837a1467759e9720399aMike Lockwood 5980927bf9690127bc45cf8837a1467759e9720399aMike Lockwood memset(languages, 0, sizeof(languages)); 5990927bf9690127bc45cf8837a1467759e9720399aMike Lockwood memset(&ctrl, 0, sizeof(ctrl)); 6000927bf9690127bc45cf8837a1467759e9720399aMike Lockwood 6010927bf9690127bc45cf8837a1467759e9720399aMike Lockwood // read list of supported languages 6020927bf9690127bc45cf8837a1467759e9720399aMike Lockwood ctrl.bRequestType = USB_DIR_IN|USB_TYPE_STANDARD|USB_RECIP_DEVICE; 6030927bf9690127bc45cf8837a1467759e9720399aMike Lockwood ctrl.bRequest = USB_REQ_GET_DESCRIPTOR; 6040927bf9690127bc45cf8837a1467759e9720399aMike Lockwood ctrl.wValue = (USB_DT_STRING << 8) | 0; 6050927bf9690127bc45cf8837a1467759e9720399aMike Lockwood ctrl.wIndex = 0; 6060927bf9690127bc45cf8837a1467759e9720399aMike Lockwood ctrl.wLength = sizeof(languages); 6070927bf9690127bc45cf8837a1467759e9720399aMike Lockwood ctrl.data = languages; 6080927bf9690127bc45cf8837a1467759e9720399aMike Lockwood 6090927bf9690127bc45cf8837a1467759e9720399aMike Lockwood result = ioctl(usb->desc, USBDEVFS_CONTROL, &ctrl); 6100927bf9690127bc45cf8837a1467759e9720399aMike Lockwood if (result > 0) 6110927bf9690127bc45cf8837a1467759e9720399aMike Lockwood languageCount = (result - 2) / 2; 6120927bf9690127bc45cf8837a1467759e9720399aMike Lockwood 6130927bf9690127bc45cf8837a1467759e9720399aMike Lockwood for (i = 1; i <= languageCount; i++) { 6140927bf9690127bc45cf8837a1467759e9720399aMike Lockwood memset(buffer, 0, sizeof(buffer)); 6150927bf9690127bc45cf8837a1467759e9720399aMike Lockwood memset(&ctrl, 0, sizeof(ctrl)); 6160927bf9690127bc45cf8837a1467759e9720399aMike Lockwood 6170927bf9690127bc45cf8837a1467759e9720399aMike Lockwood ctrl.bRequestType = USB_DIR_IN|USB_TYPE_STANDARD|USB_RECIP_DEVICE; 6180927bf9690127bc45cf8837a1467759e9720399aMike Lockwood ctrl.bRequest = USB_REQ_GET_DESCRIPTOR; 6190927bf9690127bc45cf8837a1467759e9720399aMike Lockwood ctrl.wValue = (USB_DT_STRING << 8) | serial_index; 6200927bf9690127bc45cf8837a1467759e9720399aMike Lockwood ctrl.wIndex = languages[i]; 6210927bf9690127bc45cf8837a1467759e9720399aMike Lockwood ctrl.wLength = sizeof(buffer); 6220927bf9690127bc45cf8837a1467759e9720399aMike Lockwood ctrl.data = buffer; 6230927bf9690127bc45cf8837a1467759e9720399aMike Lockwood 6240927bf9690127bc45cf8837a1467759e9720399aMike Lockwood result = ioctl(usb->desc, USBDEVFS_CONTROL, &ctrl); 6250927bf9690127bc45cf8837a1467759e9720399aMike Lockwood if (result > 0) { 6260927bf9690127bc45cf8837a1467759e9720399aMike Lockwood int i; 6270927bf9690127bc45cf8837a1467759e9720399aMike Lockwood // skip first word, and copy the rest to the serial string, changing shorts to bytes. 6280927bf9690127bc45cf8837a1467759e9720399aMike Lockwood result /= 2; 6290927bf9690127bc45cf8837a1467759e9720399aMike Lockwood for (i = 1; i < result; i++) 6300927bf9690127bc45cf8837a1467759e9720399aMike Lockwood serial[i - 1] = buffer[i]; 6310927bf9690127bc45cf8837a1467759e9720399aMike Lockwood serial[i - 1] = 0; 6320927bf9690127bc45cf8837a1467759e9720399aMike Lockwood break; 6330927bf9690127bc45cf8837a1467759e9720399aMike Lockwood } 6340927bf9690127bc45cf8837a1467759e9720399aMike Lockwood } 6350927bf9690127bc45cf8837a1467759e9720399aMike Lockwood } 636dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 637dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project /* add to the end of the active handles */ 638dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project adb_mutex_lock(&usb_lock); 639dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project usb->next = &handle_list; 640dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project usb->prev = handle_list.prev; 641dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project usb->prev->next = usb; 642dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project usb->next->prev = usb; 643dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project adb_mutex_unlock(&usb_lock); 644dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 6450927bf9690127bc45cf8837a1467759e9720399aMike Lockwood register_usb_transport(usb, serial, usb->writeable); 646dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project return; 647dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 648dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Projectfail: 649dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project D("[ usb open %s error=%d, err_str = %s]\n", 650dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project usb->fname, errno, strerror(errno)); 651dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project if(usb->desc >= 0) { 652dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project adb_close(usb->desc); 653dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project } 654dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project free(usb); 655dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project} 656dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 657dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Projectvoid* device_poll_thread(void* unused) 658dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project{ 659dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project D("Created device thread\n"); 660dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project for(;;) { 661dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project /* XXX use inotify */ 662dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project find_usb_device("/dev/bus/usb", register_device); 663dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project kick_disconnected_devices(); 664dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project sleep(1); 665dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project } 666dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project return NULL; 667dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project} 668dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 669dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Projectstatic void sigalrm_handler(int signo) 670dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project{ 671dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project // don't need to do anything here 672dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project} 673dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 674dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Projectvoid usb_init() 675dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project{ 676dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project adb_thread_t tid; 677dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project struct sigaction actions; 678dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 679dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project memset(&actions, 0, sizeof(actions)); 680dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project sigemptyset(&actions.sa_mask); 681dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project actions.sa_flags = 0; 682dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project actions.sa_handler = sigalrm_handler; 683dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project sigaction(SIGALRM,& actions, NULL); 684dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 685dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project if(adb_thread_create(&tid, device_poll_thread, NULL)){ 686dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project fatal_errno("cannot create input thread"); 687dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project } 688dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project} 689dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 690