| /* |
| * Copyright (C) 2016 The Android Open Source Project |
| * |
| * Licensed under the Apache License, Version 2.0 (the "License"); |
| * you may not use this file except in compliance with the License. |
| * You may obtain a copy of the License at |
| * |
| * http://www.apache.org/licenses/LICENSE-2.0 |
| * |
| * Unless required by applicable law or agreed to in writing, software |
| * distributed under the License is distributed on an "AS IS" BASIS, |
| * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. |
| * See the License for the specific language governing permissions and |
| * limitations under the License. |
| */ |
| |
| #include "usb.h" |
| |
| #include "sysdeps.h" |
| |
| #include <stdint.h> |
| #include <stdlib.h> |
| |
| #include <atomic> |
| #include <chrono> |
| #include <condition_variable> |
| #include <memory> |
| #include <mutex> |
| #include <string> |
| #include <thread> |
| #include <unordered_map> |
| |
| #include <libusb/libusb.h> |
| |
| #include <android-base/file.h> |
| #include <android-base/logging.h> |
| #include <android-base/stringprintf.h> |
| #include <android-base/strings.h> |
| |
| #include "adb.h" |
| #include "adb_utils.h" |
| #include "transport.h" |
| #include "usb.h" |
| |
| using android::base::StringPrintf; |
| |
| // RAII wrappers for libusb. |
| struct ConfigDescriptorDeleter { |
| void operator()(libusb_config_descriptor* desc) { |
| libusb_free_config_descriptor(desc); |
| } |
| }; |
| |
| using unique_config_descriptor = std::unique_ptr<libusb_config_descriptor, ConfigDescriptorDeleter>; |
| |
| struct DeviceHandleDeleter { |
| void operator()(libusb_device_handle* h) { |
| libusb_close(h); |
| } |
| }; |
| |
| using unique_device_handle = std::unique_ptr<libusb_device_handle, DeviceHandleDeleter>; |
| |
| struct transfer_info { |
| transfer_info(const char* name, uint16_t zero_mask, bool is_bulk_out) |
| : name(name), |
| transfer(libusb_alloc_transfer(0)), |
| is_bulk_out(is_bulk_out), |
| zero_mask(zero_mask) {} |
| |
| ~transfer_info() { |
| libusb_free_transfer(transfer); |
| } |
| |
| const char* name; |
| libusb_transfer* transfer; |
| bool is_bulk_out; |
| bool transfer_complete; |
| std::condition_variable cv; |
| std::mutex mutex; |
| uint16_t zero_mask; |
| |
| void Notify() { |
| LOG(DEBUG) << "notifying " << name << " transfer complete"; |
| transfer_complete = true; |
| cv.notify_one(); |
| } |
| }; |
| |
| namespace libusb { |
| struct usb_handle : public ::usb_handle { |
| usb_handle(const std::string& device_address, const std::string& serial, |
| unique_device_handle&& device_handle, uint8_t interface, uint8_t bulk_in, |
| uint8_t bulk_out, size_t zero_mask, size_t max_packet_size) |
| : device_address(device_address), |
| serial(serial), |
| closing(false), |
| device_handle(device_handle.release()), |
| read("read", zero_mask, false), |
| write("write", zero_mask, true), |
| interface(interface), |
| bulk_in(bulk_in), |
| bulk_out(bulk_out), |
| max_packet_size(max_packet_size) {} |
| |
| ~usb_handle() { |
| Close(); |
| } |
| |
| void Close() { |
| std::unique_lock<std::mutex> lock(device_handle_mutex); |
| // Cancelling transfers will trigger more Closes, so make sure this only happens once. |
| if (closing) { |
| return; |
| } |
| closing = true; |
| |
| // Make sure that no new transfers come in. |
| libusb_device_handle* handle = device_handle; |
| if (!handle) { |
| return; |
| } |
| |
| device_handle = nullptr; |
| |
| // Cancel already dispatched transfers. |
| libusb_cancel_transfer(read.transfer); |
| libusb_cancel_transfer(write.transfer); |
| |
| libusb_release_interface(handle, interface); |
| libusb_close(handle); |
| } |
| |
| std::string device_address; |
| std::string serial; |
| |
| std::atomic<bool> closing; |
| std::mutex device_handle_mutex; |
| libusb_device_handle* device_handle; |
| |
| transfer_info read; |
| transfer_info write; |
| |
| uint8_t interface; |
| uint8_t bulk_in; |
| uint8_t bulk_out; |
| |
| size_t max_packet_size; |
| }; |
| |
| static auto& usb_handles = *new std::unordered_map<std::string, std::unique_ptr<usb_handle>>(); |
| static auto& usb_handles_mutex = *new std::mutex(); |
| |
| static libusb_hotplug_callback_handle hotplug_handle; |
| |
| static std::string get_device_address(libusb_device* device) { |
| return StringPrintf("usb:%d:%d", libusb_get_bus_number(device), |
| libusb_get_device_address(device)); |
| } |
| |
| #if defined(__linux__) |
| static std::string get_device_serial_path(libusb_device* device) { |
| uint8_t ports[7]; |
| int port_count = libusb_get_port_numbers(device, ports, 7); |
| if (port_count < 0) return ""; |
| |
| std::string path = |
| StringPrintf("/sys/bus/usb/devices/%d-%d", libusb_get_bus_number(device), ports[0]); |
| for (int port = 1; port < port_count; ++port) { |
| path += StringPrintf(".%d", ports[port]); |
| } |
| path += "/serial"; |
| return path; |
| } |
| |
| static std::string get_device_dev_path(libusb_device* device) { |
| uint8_t ports[7]; |
| int port_count = libusb_get_port_numbers(device, ports, 7); |
| if (port_count < 0) return ""; |
| return StringPrintf("/dev/bus/usb/%03u/%03u", libusb_get_bus_number(device), ports[0]); |
| } |
| #endif |
| |
| static bool endpoint_is_output(uint8_t endpoint) { |
| return (endpoint & LIBUSB_ENDPOINT_DIR_MASK) == LIBUSB_ENDPOINT_OUT; |
| } |
| |
| static bool should_perform_zero_transfer(uint8_t endpoint, size_t write_length, uint16_t zero_mask) { |
| return endpoint_is_output(endpoint) && write_length != 0 && zero_mask != 0 && |
| (write_length & zero_mask) == 0; |
| } |
| |
| static void process_device(libusb_device* device) { |
| std::string device_address = get_device_address(device); |
| std::string device_serial; |
| |
| // Figure out if we want to open the device. |
| libusb_device_descriptor device_desc; |
| int rc = libusb_get_device_descriptor(device, &device_desc); |
| if (rc != 0) { |
| LOG(WARNING) << "failed to get device descriptor for device at " << device_address << ": " |
| << libusb_error_name(rc); |
| return; |
| } |
| |
| if (device_desc.bDeviceClass != LIBUSB_CLASS_PER_INTERFACE) { |
| // Assume that all Android devices have the device class set to per interface. |
| // TODO: Is this assumption valid? |
| LOG(VERBOSE) << "skipping device with incorrect class at " << device_address; |
| return; |
| } |
| |
| libusb_config_descriptor* config_raw; |
| rc = libusb_get_active_config_descriptor(device, &config_raw); |
| if (rc != 0) { |
| LOG(WARNING) << "failed to get active config descriptor for device at " << device_address |
| << ": " << libusb_error_name(rc); |
| return; |
| } |
| const unique_config_descriptor config(config_raw); |
| |
| // Use size_t for interface_num so <iostream>s don't mangle it. |
| size_t interface_num; |
| uint16_t zero_mask = 0; |
| uint8_t bulk_in = 0, bulk_out = 0; |
| size_t packet_size = 0; |
| bool found_adb = false; |
| |
| for (interface_num = 0; interface_num < config->bNumInterfaces; ++interface_num) { |
| const libusb_interface& interface = config->interface[interface_num]; |
| if (interface.num_altsetting != 1) { |
| // Assume that interfaces with alternate settings aren't adb interfaces. |
| // TODO: Is this assumption valid? |
| LOG(VERBOSE) << "skipping interface with incorrect num_altsetting at " << device_address |
| << " (interface " << interface_num << ")"; |
| continue; |
| } |
| |
| const libusb_interface_descriptor& interface_desc = interface.altsetting[0]; |
| if (!is_adb_interface(interface_desc.bInterfaceClass, interface_desc.bInterfaceSubClass, |
| interface_desc.bInterfaceProtocol)) { |
| LOG(VERBOSE) << "skipping non-adb interface at " << device_address << " (interface " |
| << interface_num << ")"; |
| continue; |
| } |
| |
| LOG(VERBOSE) << "found potential adb interface at " << device_address << " (interface " |
| << interface_num << ")"; |
| |
| bool found_in = false; |
| bool found_out = false; |
| for (size_t endpoint_num = 0; endpoint_num < interface_desc.bNumEndpoints; ++endpoint_num) { |
| const auto& endpoint_desc = interface_desc.endpoint[endpoint_num]; |
| const uint8_t endpoint_addr = endpoint_desc.bEndpointAddress; |
| const uint8_t endpoint_attr = endpoint_desc.bmAttributes; |
| |
| const uint8_t transfer_type = endpoint_attr & LIBUSB_TRANSFER_TYPE_MASK; |
| |
| if (transfer_type != LIBUSB_TRANSFER_TYPE_BULK) { |
| continue; |
| } |
| |
| if (endpoint_is_output(endpoint_addr) && !found_out) { |
| found_out = true; |
| bulk_out = endpoint_addr; |
| zero_mask = endpoint_desc.wMaxPacketSize - 1; |
| } else if (!endpoint_is_output(endpoint_addr) && !found_in) { |
| found_in = true; |
| bulk_in = endpoint_addr; |
| } |
| |
| size_t endpoint_packet_size = endpoint_desc.wMaxPacketSize; |
| CHECK(endpoint_packet_size != 0); |
| if (packet_size == 0) { |
| packet_size = endpoint_packet_size; |
| } else { |
| CHECK(packet_size == endpoint_packet_size); |
| } |
| } |
| |
| if (found_in && found_out) { |
| found_adb = true; |
| break; |
| } else { |
| LOG(VERBOSE) << "rejecting potential adb interface at " << device_address |
| << "(interface " << interface_num << "): missing bulk endpoints " |
| << "(found_in = " << found_in << ", found_out = " << found_out << ")"; |
| } |
| } |
| |
| if (!found_adb) { |
| LOG(VERBOSE) << "skipping device with no adb interfaces at " << device_address; |
| return; |
| } |
| |
| { |
| std::unique_lock<std::mutex> lock(usb_handles_mutex); |
| if (usb_handles.find(device_address) != usb_handles.end()) { |
| LOG(VERBOSE) << "device at " << device_address |
| << " has already been registered, skipping"; |
| return; |
| } |
| } |
| |
| bool writable = true; |
| libusb_device_handle* handle_raw = nullptr; |
| rc = libusb_open(device, &handle_raw); |
| unique_device_handle handle(handle_raw); |
| if (rc == 0) { |
| LOG(DEBUG) << "successfully opened adb device at " << device_address << ", " |
| << StringPrintf("bulk_in = %#x, bulk_out = %#x", bulk_in, bulk_out); |
| |
| device_serial.resize(255); |
| rc = libusb_get_string_descriptor_ascii(handle_raw, device_desc.iSerialNumber, |
| reinterpret_cast<unsigned char*>(&device_serial[0]), |
| device_serial.length()); |
| if (rc == 0) { |
| LOG(WARNING) << "received empty serial from device at " << device_address; |
| return; |
| } else if (rc < 0) { |
| LOG(WARNING) << "failed to get serial from device at " << device_address |
| << libusb_error_name(rc); |
| return; |
| } |
| device_serial.resize(rc); |
| |
| // WARNING: this isn't released via RAII. |
| rc = libusb_claim_interface(handle.get(), interface_num); |
| if (rc != 0) { |
| LOG(WARNING) << "failed to claim adb interface for device '" << device_serial << "'" |
| << libusb_error_name(rc); |
| return; |
| } |
| |
| for (uint8_t endpoint : {bulk_in, bulk_out}) { |
| rc = libusb_clear_halt(handle.get(), endpoint); |
| if (rc != 0) { |
| LOG(WARNING) << "failed to clear halt on device '" << device_serial |
| << "' endpoint 0x" << std::hex << endpoint << ": " |
| << libusb_error_name(rc); |
| libusb_release_interface(handle.get(), interface_num); |
| return; |
| } |
| } |
| } else { |
| LOG(WARNING) << "failed to open usb device at " << device_address << ": " |
| << libusb_error_name(rc); |
| writable = false; |
| |
| #if defined(__linux__) |
| // libusb doesn't think we should be messing around with devices we don't have |
| // write access to, but Linux at least lets us get the serial number anyway. |
| if (!android::base::ReadFileToString(get_device_serial_path(device), &device_serial)) { |
| // We don't actually want to treat an unknown serial as an error because |
| // devices aren't able to communicate a serial number in early bringup. |
| // http://b/20883914 |
| device_serial = "unknown"; |
| } |
| device_serial = android::base::Trim(device_serial); |
| #else |
| // On Mac OS and Windows, we're screwed. But I don't think this situation actually |
| // happens on those OSes. |
| return; |
| #endif |
| } |
| |
| std::unique_ptr<usb_handle> result(new usb_handle(device_address, device_serial, |
| std::move(handle), interface_num, bulk_in, |
| bulk_out, zero_mask, packet_size)); |
| usb_handle* usb_handle_raw = result.get(); |
| |
| { |
| std::unique_lock<std::mutex> lock(usb_handles_mutex); |
| usb_handles[device_address] = std::move(result); |
| |
| register_usb_transport(usb_handle_raw, device_serial.c_str(), device_address.c_str(), |
| writable); |
| } |
| LOG(INFO) << "registered new usb device '" << device_serial << "'"; |
| } |
| |
| static std::atomic<int> connecting_devices(0); |
| |
| static void device_connected(libusb_device* device) { |
| #if defined(__linux__) |
| // Android's host linux libusb uses netlink instead of udev for device hotplug notification, |
| // which means we can get hotplug notifications before udev has updated ownership/perms on the |
| // device. Since we're not going to be able to link against the system's libudev any time soon, |
| // hack around this by inserting a sleep. |
| auto thread = std::thread([device]() { |
| std::string device_path = get_device_dev_path(device); |
| std::this_thread::sleep_for(std::chrono::seconds(1)); |
| |
| process_device(device); |
| if (--connecting_devices == 0) { |
| adb_notify_device_scan_complete(); |
| } |
| }); |
| thread.detach(); |
| #else |
| process_device(device); |
| #endif |
| } |
| |
| static void device_disconnected(libusb_device* device) { |
| std::string device_address = get_device_address(device); |
| |
| LOG(INFO) << "device disconnected: " << device_address; |
| std::unique_lock<std::mutex> lock(usb_handles_mutex); |
| auto it = usb_handles.find(device_address); |
| if (it != usb_handles.end()) { |
| if (!it->second->device_handle) { |
| // If the handle is null, we were never able to open the device. |
| |
| // Temporarily release the usb handles mutex to avoid deadlock. |
| std::unique_ptr<usb_handle> handle = std::move(it->second); |
| usb_handles.erase(it); |
| lock.unlock(); |
| unregister_usb_transport(handle.get()); |
| lock.lock(); |
| } else { |
| // Closure of the transport will erase the usb_handle. |
| } |
| } |
| } |
| |
| static auto& hotplug_queue = *new BlockingQueue<std::pair<libusb_hotplug_event, libusb_device*>>(); |
| static void hotplug_thread() { |
| adb_thread_setname("libusb hotplug"); |
| while (true) { |
| hotplug_queue.PopAll([](std::pair<libusb_hotplug_event, libusb_device*> pair) { |
| libusb_hotplug_event event = pair.first; |
| libusb_device* device = pair.second; |
| if (event == LIBUSB_HOTPLUG_EVENT_DEVICE_ARRIVED) { |
| device_connected(device); |
| } else if (event == LIBUSB_HOTPLUG_EVENT_DEVICE_LEFT) { |
| device_disconnected(device); |
| } |
| }); |
| } |
| } |
| |
| static LIBUSB_CALL int hotplug_callback(libusb_context*, libusb_device* device, |
| libusb_hotplug_event event, void*) { |
| // We're called with the libusb lock taken. Call these on a separate thread outside of this |
| // function so that the usb_handle mutex is always taken before the libusb mutex. |
| static std::once_flag once; |
| std::call_once(once, []() { std::thread(hotplug_thread).detach(); }); |
| |
| if (event == LIBUSB_HOTPLUG_EVENT_DEVICE_ARRIVED) { |
| ++connecting_devices; |
| } |
| hotplug_queue.Push({event, device}); |
| return 0; |
| } |
| |
| void usb_init() { |
| LOG(DEBUG) << "initializing libusb..."; |
| int rc = libusb_init(nullptr); |
| if (rc != 0) { |
| LOG(FATAL) << "failed to initialize libusb: " << libusb_error_name(rc); |
| } |
| |
| // Register the hotplug callback. |
| rc = libusb_hotplug_register_callback( |
| nullptr, static_cast<libusb_hotplug_event>(LIBUSB_HOTPLUG_EVENT_DEVICE_ARRIVED | |
| LIBUSB_HOTPLUG_EVENT_DEVICE_LEFT), |
| LIBUSB_HOTPLUG_ENUMERATE, LIBUSB_HOTPLUG_MATCH_ANY, LIBUSB_HOTPLUG_MATCH_ANY, |
| LIBUSB_CLASS_PER_INTERFACE, hotplug_callback, nullptr, &hotplug_handle); |
| |
| if (rc != LIBUSB_SUCCESS) { |
| LOG(FATAL) << "failed to register libusb hotplug callback"; |
| } |
| |
| // Spawn a thread for libusb_handle_events. |
| std::thread([]() { |
| adb_thread_setname("libusb"); |
| while (true) { |
| libusb_handle_events(nullptr); |
| } |
| }).detach(); |
| } |
| |
| void usb_cleanup() { |
| libusb_hotplug_deregister_callback(nullptr, hotplug_handle); |
| } |
| |
| static LIBUSB_CALL void transfer_callback(libusb_transfer* transfer) { |
| transfer_info* info = static_cast<transfer_info*>(transfer->user_data); |
| |
| LOG(DEBUG) << info->name << " transfer callback entered"; |
| |
| // Make sure that the original submitter has made it to the condition_variable wait. |
| std::unique_lock<std::mutex> lock(info->mutex); |
| |
| LOG(DEBUG) << info->name << " callback successfully acquired lock"; |
| |
| if (transfer->status != LIBUSB_TRANSFER_COMPLETED) { |
| LOG(WARNING) << info->name << " transfer failed: " << libusb_error_name(transfer->status); |
| info->Notify(); |
| return; |
| } |
| |
| // usb_read() can return when receiving some data. |
| if (info->is_bulk_out && transfer->actual_length != transfer->length) { |
| LOG(DEBUG) << info->name << " transfer incomplete, resubmitting"; |
| transfer->length -= transfer->actual_length; |
| transfer->buffer += transfer->actual_length; |
| int rc = libusb_submit_transfer(transfer); |
| if (rc != 0) { |
| LOG(WARNING) << "failed to submit " << info->name |
| << " transfer: " << libusb_error_name(rc); |
| transfer->status = LIBUSB_TRANSFER_ERROR; |
| info->Notify(); |
| } |
| return; |
| } |
| |
| if (should_perform_zero_transfer(transfer->endpoint, transfer->length, info->zero_mask)) { |
| LOG(DEBUG) << "submitting zero-length write"; |
| transfer->length = 0; |
| int rc = libusb_submit_transfer(transfer); |
| if (rc != 0) { |
| LOG(WARNING) << "failed to submit zero-length write: " << libusb_error_name(rc); |
| transfer->status = LIBUSB_TRANSFER_ERROR; |
| info->Notify(); |
| } |
| return; |
| } |
| |
| LOG(VERBOSE) << info->name << "transfer fully complete"; |
| info->Notify(); |
| } |
| |
| // Dispatch a libusb transfer, unlock |device_lock|, and then wait for the result. |
| static int perform_usb_transfer(usb_handle* h, transfer_info* info, |
| std::unique_lock<std::mutex> device_lock) { |
| libusb_transfer* transfer = info->transfer; |
| |
| transfer->user_data = info; |
| transfer->callback = transfer_callback; |
| |
| LOG(DEBUG) << "locking " << info->name << " transfer_info mutex"; |
| std::unique_lock<std::mutex> lock(info->mutex); |
| info->transfer_complete = false; |
| LOG(DEBUG) << "submitting " << info->name << " transfer"; |
| int rc = libusb_submit_transfer(transfer); |
| if (rc != 0) { |
| LOG(WARNING) << "failed to submit " << info->name << " transfer: " << libusb_error_name(rc); |
| errno = EIO; |
| return -1; |
| } |
| |
| LOG(DEBUG) << info->name << " transfer successfully submitted"; |
| device_lock.unlock(); |
| info->cv.wait(lock, [info]() { return info->transfer_complete; }); |
| if (transfer->status != 0) { |
| errno = EIO; |
| return -1; |
| } |
| |
| return 0; |
| } |
| |
| int usb_write(usb_handle* h, const void* d, int len) { |
| LOG(DEBUG) << "usb_write of length " << len; |
| |
| std::unique_lock<std::mutex> lock(h->device_handle_mutex); |
| if (!h->device_handle) { |
| errno = EIO; |
| return -1; |
| } |
| |
| transfer_info* info = &h->write; |
| info->transfer->dev_handle = h->device_handle; |
| info->transfer->flags = 0; |
| info->transfer->endpoint = h->bulk_out; |
| info->transfer->type = LIBUSB_TRANSFER_TYPE_BULK; |
| info->transfer->length = len; |
| info->transfer->buffer = reinterpret_cast<unsigned char*>(const_cast<void*>(d)); |
| info->transfer->num_iso_packets = 0; |
| |
| int rc = perform_usb_transfer(h, info, std::move(lock)); |
| LOG(DEBUG) << "usb_write(" << len << ") = " << rc; |
| return info->transfer->actual_length; |
| } |
| |
| int usb_read(usb_handle* h, void* d, int len) { |
| LOG(DEBUG) << "usb_read of length " << len; |
| |
| std::unique_lock<std::mutex> lock(h->device_handle_mutex); |
| if (!h->device_handle) { |
| errno = EIO; |
| return -1; |
| } |
| |
| transfer_info* info = &h->read; |
| info->transfer->dev_handle = h->device_handle; |
| info->transfer->flags = 0; |
| info->transfer->endpoint = h->bulk_in; |
| info->transfer->type = LIBUSB_TRANSFER_TYPE_BULK; |
| info->transfer->length = len; |
| info->transfer->buffer = reinterpret_cast<unsigned char*>(d); |
| info->transfer->num_iso_packets = 0; |
| |
| int rc = perform_usb_transfer(h, info, std::move(lock)); |
| LOG(DEBUG) << "usb_read(" << len << ") = " << rc << ", actual_length " |
| << info->transfer->actual_length; |
| if (rc < 0) { |
| return rc; |
| } |
| return info->transfer->actual_length; |
| } |
| |
| int usb_close(usb_handle* h) { |
| std::unique_lock<std::mutex> lock(usb_handles_mutex); |
| auto it = usb_handles.find(h->device_address); |
| if (it == usb_handles.end()) { |
| LOG(FATAL) << "attempted to close unregistered usb_handle for '" << h->serial << "'"; |
| } |
| usb_handles.erase(h->device_address); |
| return 0; |
| } |
| |
| void usb_reset(usb_handle* h) { |
| libusb_reset_device(h->device_handle); |
| usb_kick(h); |
| } |
| |
| void usb_kick(usb_handle* h) { |
| h->Close(); |
| } |
| |
| size_t usb_get_max_packet_size(usb_handle* h) { |
| CHECK(h->max_packet_size != 0); |
| return h->max_packet_size; |
| } |
| |
| } // namespace libusb |