533 lines
15 KiB
C
533 lines
15 KiB
C
/*
|
|
* Test suite program based of libusb-0.1-compat testlibusb
|
|
* Copyright (c) 2013 Nathan Hjelm <hjelmn@mac.ccom>
|
|
*
|
|
* This library is free software; you can redistribute it and/or
|
|
* modify it under the terms of the GNU Lesser General Public
|
|
* License as published by the Free Software Foundation; either
|
|
* version 2.1 of the License, or (at your option) any later version.
|
|
*
|
|
* This library is distributed in the hope that it will be useful,
|
|
* but WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
|
|
* Lesser General Public License for more details.
|
|
*
|
|
* You should have received a copy of the GNU Lesser General Public
|
|
* License along with this library; if not, write to the Free Software
|
|
* Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA
|
|
*/
|
|
|
|
#include <stdio.h>
|
|
#include <string.h>
|
|
#include "libusb-1.0/libusb.h"
|
|
|
|
#define ENDPOINT_OUT 0x01
|
|
#define ENDPOINT_IN 0x81
|
|
int verbose = 0;
|
|
|
|
static void print_endpoint_comp(const struct libusb_ss_endpoint_companion_descriptor* ep_comp)
|
|
{
|
|
printf(" USB 3.0 Endpoint Companion:\n");
|
|
printf(" bMaxBurst: %u\n", ep_comp->bMaxBurst);
|
|
printf(" bmAttributes: %02xh\n", ep_comp->bmAttributes);
|
|
printf(" wBytesPerInterval: %u\n", ep_comp->wBytesPerInterval);
|
|
}
|
|
|
|
static void print_endpoint(const struct libusb_endpoint_descriptor* endpoint)
|
|
{
|
|
int i, ret;
|
|
|
|
printf(" Endpoint:\n");
|
|
printf(" bEndpointAddress: %02xh\n", endpoint->bEndpointAddress);
|
|
printf(" bmAttributes: %02xh\n", endpoint->bmAttributes);
|
|
printf(" wMaxPacketSize: %u\n", endpoint->wMaxPacketSize);
|
|
printf(" bInterval: %u\n", endpoint->bInterval);
|
|
printf(" bRefresh: %u\n", endpoint->bRefresh);
|
|
printf(" bSynchAddress: %u\n", endpoint->bSynchAddress);
|
|
|
|
for (i = 0; i < endpoint->extra_length;)
|
|
{
|
|
if (LIBUSB_DT_SS_ENDPOINT_COMPANION == endpoint->extra[i + 1])
|
|
{
|
|
struct libusb_ss_endpoint_companion_descriptor* ep_comp;
|
|
|
|
ret = libusb_get_ss_endpoint_companion_descriptor(NULL, endpoint, &ep_comp);
|
|
if (LIBUSB_SUCCESS != ret)
|
|
{
|
|
continue;
|
|
}
|
|
|
|
print_endpoint_comp(ep_comp);
|
|
|
|
libusb_free_ss_endpoint_companion_descriptor(ep_comp);
|
|
}
|
|
|
|
i += endpoint->extra[i];
|
|
}
|
|
}
|
|
|
|
static void print_altsetting(const struct libusb_interface_descriptor* interface)
|
|
{
|
|
uint8_t i;
|
|
|
|
printf(" Interface:\n");
|
|
printf(" bInterfaceNumber: %u\n", interface->bInterfaceNumber);
|
|
printf(" bAlternateSetting: %u\n", interface->bAlternateSetting);
|
|
printf(" bNumEndpoints: %u\n", interface->bNumEndpoints);
|
|
printf(" bInterfaceClass: %u\n", interface->bInterfaceClass);
|
|
printf(" bInterfaceSubClass: %u\n", interface->bInterfaceSubClass);
|
|
printf(" bInterfaceProtocol: %u\n", interface->bInterfaceProtocol);
|
|
printf(" iInterface: %u\n", interface->iInterface);
|
|
|
|
for (i = 0; i < interface->bNumEndpoints; i++)
|
|
{
|
|
print_endpoint(&interface->endpoint[i]);
|
|
}
|
|
}
|
|
|
|
static void print_2_0_ext_cap(struct libusb_usb_2_0_extension_descriptor* usb_2_0_ext_cap)
|
|
{
|
|
printf(" USB 2.0 Extension Capabilities:\n");
|
|
printf(" bDevCapabilityType: %u\n", usb_2_0_ext_cap->bDevCapabilityType);
|
|
printf(" bmAttributes: %08xh\n", usb_2_0_ext_cap->bmAttributes);
|
|
}
|
|
|
|
static void print_ss_usb_cap(struct libusb_ss_usb_device_capability_descriptor* ss_usb_cap)
|
|
{
|
|
printf(" USB 3.0 Capabilities:\n");
|
|
printf(" bDevCapabilityType: %u\n", ss_usb_cap->bDevCapabilityType);
|
|
printf(" bmAttributes: %02xh\n", ss_usb_cap->bmAttributes);
|
|
printf(" wSpeedSupported: %u\n", ss_usb_cap->wSpeedSupported);
|
|
printf(" bFunctionalitySupport: %u\n", ss_usb_cap->bFunctionalitySupport);
|
|
printf(" bU1devExitLat: %u\n", ss_usb_cap->bU1DevExitLat);
|
|
printf(" bU2devExitLat: %u\n", ss_usb_cap->bU2DevExitLat);
|
|
}
|
|
|
|
static void print_bos(libusb_device_handle* handle)
|
|
{
|
|
struct libusb_bos_descriptor* bos;
|
|
uint8_t i;
|
|
int ret;
|
|
|
|
ret = libusb_get_bos_descriptor(handle, &bos);
|
|
if (ret < 0)
|
|
{
|
|
return;
|
|
}
|
|
|
|
printf(" Binary Object Store (BOS):\n");
|
|
printf(" wTotalLength: %u\n", bos->wTotalLength);
|
|
printf(" bNumDeviceCaps: %u\n", bos->bNumDeviceCaps);
|
|
|
|
for (i = 0; i < bos->bNumDeviceCaps; i++)
|
|
{
|
|
struct libusb_bos_dev_capability_descriptor* dev_cap = bos->dev_capability[i];
|
|
|
|
if (dev_cap->bDevCapabilityType == LIBUSB_BT_USB_2_0_EXTENSION)
|
|
{
|
|
struct libusb_usb_2_0_extension_descriptor* usb_2_0_extension;
|
|
|
|
ret = libusb_get_usb_2_0_extension_descriptor(NULL, dev_cap, &usb_2_0_extension);
|
|
if (ret < 0)
|
|
{
|
|
return;
|
|
}
|
|
|
|
print_2_0_ext_cap(usb_2_0_extension);
|
|
libusb_free_usb_2_0_extension_descriptor(usb_2_0_extension);
|
|
}
|
|
else
|
|
if (dev_cap->bDevCapabilityType == LIBUSB_BT_SS_USB_DEVICE_CAPABILITY)
|
|
{
|
|
struct libusb_ss_usb_device_capability_descriptor* ss_dev_cap;
|
|
|
|
ret = libusb_get_ss_usb_device_capability_descriptor(NULL, dev_cap, &ss_dev_cap);
|
|
if (ret < 0)
|
|
{
|
|
return;
|
|
}
|
|
|
|
print_ss_usb_cap(ss_dev_cap);
|
|
libusb_free_ss_usb_device_capability_descriptor(ss_dev_cap);
|
|
}
|
|
}
|
|
|
|
libusb_free_bos_descriptor(bos);
|
|
}
|
|
|
|
static void print_interface(const struct libusb_interface* interface)
|
|
{
|
|
int i;
|
|
|
|
for (i = 0; i < interface->num_altsetting; i++)
|
|
{
|
|
print_altsetting(&interface->altsetting[i]);
|
|
}
|
|
}
|
|
|
|
static void print_configuration(struct libusb_config_descriptor* config)
|
|
{
|
|
uint8_t i;
|
|
|
|
printf(" Configuration:\n");
|
|
printf(" wTotalLength: %u\n", config->wTotalLength);
|
|
printf(" bNumInterfaces: %u\n", config->bNumInterfaces);
|
|
printf(" bConfigurationValue: %u\n", config->bConfigurationValue);
|
|
printf(" iConfiguration: %u\n", config->iConfiguration);
|
|
printf(" bmAttributes: %02xh\n", config->bmAttributes);
|
|
printf(" MaxPower: %u\n", config->MaxPower);
|
|
|
|
for (i = 0; i < config->bNumInterfaces; i++)
|
|
{
|
|
print_interface(&config->interface[i]);
|
|
}
|
|
}
|
|
|
|
|
|
static void set_rpms(libusb_device* dev, libusb_device_handle* handle)
|
|
{
|
|
|
|
int rpms = 0;
|
|
int i = 0;
|
|
for (i = 1; i<=10; i++)
|
|
{
|
|
int rpms = i * 1000;
|
|
printf("Setting RPM to %i\n", rpms);
|
|
//sleep(5);
|
|
}
|
|
}
|
|
|
|
static void print_device(libusb_device* dev, libusb_device_handle* handle)
|
|
{
|
|
struct libusb_device_descriptor desc;
|
|
unsigned char string[256];
|
|
const char* speed;
|
|
int ret;
|
|
uint8_t i;
|
|
|
|
switch (libusb_get_device_speed(dev))
|
|
{
|
|
case LIBUSB_SPEED_LOW:
|
|
speed = "1.5M";
|
|
break;
|
|
case LIBUSB_SPEED_FULL:
|
|
speed = "12M";
|
|
break;
|
|
case LIBUSB_SPEED_HIGH:
|
|
speed = "480M";
|
|
break;
|
|
case LIBUSB_SPEED_SUPER:
|
|
speed = "5G";
|
|
break;
|
|
case LIBUSB_SPEED_SUPER_PLUS:
|
|
speed = "10G";
|
|
break;
|
|
default:
|
|
speed = "Unknown";
|
|
}
|
|
|
|
ret = libusb_get_device_descriptor(dev, &desc);
|
|
if (ret < 0)
|
|
{
|
|
fprintf(stderr, "failed to get device descriptor");
|
|
return;
|
|
}
|
|
|
|
printf("Dev (bus %u, device %u): %04X - %04X speed: %s\n",
|
|
libusb_get_bus_number(dev), libusb_get_device_address(dev),
|
|
desc.idVendor, desc.idProduct, speed);
|
|
|
|
if (!handle)
|
|
{
|
|
libusb_open(dev, &handle);
|
|
}
|
|
|
|
if (handle)
|
|
{
|
|
if (desc.iManufacturer)
|
|
{
|
|
ret = libusb_get_string_descriptor_ascii(handle, desc.iManufacturer, string, sizeof(string));
|
|
if (ret > 0)
|
|
{
|
|
printf(" Manufacturer: %s\n", (char*)string);
|
|
}
|
|
}
|
|
|
|
if (desc.iProduct)
|
|
{
|
|
ret = libusb_get_string_descriptor_ascii(handle, desc.iProduct, string, sizeof(string));
|
|
if (ret > 0)
|
|
{
|
|
printf(" Product: %s\n", (char*)string);
|
|
}
|
|
}
|
|
|
|
if (desc.iSerialNumber && verbose)
|
|
{
|
|
ret = libusb_get_string_descriptor_ascii(handle, desc.iSerialNumber, string, sizeof(string));
|
|
if (ret > 0)
|
|
{
|
|
printf(" Serial Number: %s\n", (char*)string);
|
|
}
|
|
}
|
|
}
|
|
|
|
if (verbose)
|
|
{
|
|
for (i = 0; i < desc.bNumConfigurations; i++)
|
|
{
|
|
struct libusb_config_descriptor* config;
|
|
|
|
ret = libusb_get_config_descriptor(dev, i, &config);
|
|
if (LIBUSB_SUCCESS != ret)
|
|
{
|
|
printf(" Couldn't retrieve descriptors\n");
|
|
continue;
|
|
}
|
|
|
|
print_configuration(config);
|
|
|
|
libusb_free_config_descriptor(config);
|
|
}
|
|
|
|
if (handle && desc.bcdUSB >= 0x0201)
|
|
{
|
|
print_bos(handle);
|
|
}
|
|
}
|
|
|
|
if (handle)
|
|
{
|
|
libusb_close(handle);
|
|
}
|
|
}
|
|
/*
|
|
static void print_device(libusb_device *dev, libusb_device_handle *handle)
|
|
{
|
|
struct libusb_device_descriptor desc;
|
|
unsigned char string[256];
|
|
const char *speed;
|
|
int ret;
|
|
uint8_t i;
|
|
|
|
switch (libusb_get_device_speed(dev)) {
|
|
case LIBUSB_SPEED_LOW: speed = "1.5M"; break;
|
|
case LIBUSB_SPEED_FULL: speed = "12M"; break;
|
|
case LIBUSB_SPEED_HIGH: speed = "480M"; break;
|
|
case LIBUSB_SPEED_SUPER: speed = "5G"; break;
|
|
case LIBUSB_SPEED_SUPER_PLUS: speed = "10G"; break;
|
|
default: speed = "Unknown";
|
|
}
|
|
|
|
ret = libusb_get_device_descriptor(dev, &desc);
|
|
if (ret < 0) {
|
|
fprintf(stderr, "failed to get device descriptor");
|
|
return;
|
|
}
|
|
|
|
printf("Dev (bus %u, device %u): %04X - %04X speed: %s\n",
|
|
libusb_get_bus_number(dev), libusb_get_device_address(dev),
|
|
desc.idVendor, desc.idProduct, speed);
|
|
|
|
if (!handle)
|
|
libusb_open(dev, &handle);
|
|
|
|
if (handle) {
|
|
if (desc.iManufacturer) {
|
|
ret = libusb_get_string_descriptor_ascii(handle, desc.iManufacturer, string, sizeof(string));
|
|
if (ret > 0)
|
|
printf(" Manufacturer: %s\n", (char *)string);
|
|
}
|
|
|
|
if (desc.iProduct) {
|
|
ret = libusb_get_string_descriptor_ascii(handle, desc.iProduct, string, sizeof(string));
|
|
if (ret > 0)
|
|
printf(" Product: %s\n", (char *)string);
|
|
}
|
|
|
|
if (desc.iSerialNumber && verbose) {
|
|
ret = libusb_get_string_descriptor_ascii(handle, desc.iSerialNumber, string, sizeof(string));
|
|
if (ret > 0)
|
|
printf(" Serial Number: %s\n", (char *)string);
|
|
}
|
|
}
|
|
|
|
if (verbose) {
|
|
for (i = 0; i < desc.bNumConfigurations; i++) {
|
|
struct libusb_config_descriptor *config;
|
|
ret = libusb_get_config_descriptor(dev, i, &config);
|
|
if (LIBUSB_SUCCESS != ret) {
|
|
printf(" Couldn't retrieve descriptors\n");
|
|
continue;
|
|
}
|
|
|
|
print_configuration(config);
|
|
|
|
libusb_free_config_descriptor(config);
|
|
}
|
|
|
|
if (handle && desc.bcdUSB >= 0x0201)
|
|
print_bos(handle);
|
|
}
|
|
|
|
if (handle)
|
|
libusb_close(handle);
|
|
}
|
|
*/
|
|
#ifdef __linux__
|
|
#include <errno.h>
|
|
#include <fcntl.h>
|
|
#include <unistd.h>
|
|
|
|
static int test_wrapped_device(const char* device_name)
|
|
{
|
|
libusb_device_handle* handle;
|
|
int r, fd;
|
|
|
|
fd = open(device_name, O_RDWR);
|
|
if (fd < 0)
|
|
{
|
|
printf("Error could not open %s: %s\n", device_name, strerror(errno));
|
|
return 1;
|
|
}
|
|
r = libusb_wrap_sys_device(NULL, fd, &handle);
|
|
if (r)
|
|
{
|
|
printf("Error wrapping device: %s: %s\n", device_name, libusb_strerror(r));
|
|
close(fd);
|
|
return 1;
|
|
}
|
|
print_device(libusb_get_device(handle), handle);
|
|
close(fd);
|
|
return 0;
|
|
}
|
|
#else
|
|
static int test_wrapped_device(const char* device_name)
|
|
{
|
|
(void)device_name;
|
|
printf("Testing wrapped devices is not supported on your platform\n");
|
|
return 1;
|
|
}
|
|
#endif
|
|
|
|
int main(int argc, char* argv[])
|
|
{
|
|
const char* device_name = NULL;
|
|
libusb_device** devs;
|
|
libusb_device* dev;
|
|
ssize_t cnt;
|
|
int r, i;
|
|
|
|
r = libusb_init(NULL);
|
|
if (r < 0)
|
|
{
|
|
return r;
|
|
}
|
|
|
|
cnt = libusb_get_device_list(NULL, &devs);
|
|
if (cnt < 0)
|
|
{
|
|
libusb_exit(NULL);
|
|
return 1;
|
|
}
|
|
|
|
/*
|
|
}
|
|
*/
|
|
|
|
int devindx = 0;
|
|
for (i = 0; i<12; i++)
|
|
{
|
|
//int b = print_device(&devs[i], NULL);
|
|
//if (b == "9823") {
|
|
devindx = i;
|
|
//break;
|
|
//}
|
|
}
|
|
i = 0;
|
|
dev = devs[devindx];
|
|
|
|
print_device(dev, NULL);
|
|
|
|
int d = 99;
|
|
libusb_device_handle* handle = NULL;
|
|
if (!handle)
|
|
{
|
|
d=libusb_open(dev, &handle);
|
|
}
|
|
|
|
int len = 0;
|
|
|
|
if(libusb_kernel_driver_active(handle, 0) == 1)
|
|
{
|
|
d = libusb_detach_kernel_driver(handle, 0);
|
|
}
|
|
|
|
fprintf(stderr,"%i",d);
|
|
d = libusb_claim_interface(handle, 0);
|
|
|
|
fprintf(stderr,"%i",d);
|
|
|
|
//int rpm_array[20] = {41574, 48580, 54308, 58612, 60160, 61916, 62347, 62777, 63089, 63243, 63505, 63673, 63778, 63908, 64002, 64084, 64140, 64175, 64224, 64313};
|
|
//int rpm_array[20] = {41574, 48580, 54308, 58612, 60160, 61416, 61952, 62470, 62969, 63231, 63305, 63673, 63749, 63998, 64002, 64084, 64140, 64175, 64224, 64313};
|
|
//int rpm_array[10] = {58612, 62112, 63053, 63719, 64044, 64313, 64480, 64622, 64719, 64807};
|
|
//int rpm_array[10] = {24701, 42244, 54308, 54308, 64255, 64313, 64480, 64622, 64719, 64807};
|
|
int rpms = 0;
|
|
int iiii = 189;
|
|
|
|
unsigned char bytes[65];
|
|
|
|
int rpm_array[21] = {41574, 48580, 54308, 58612, 60160, 61113, 61916, 62347, 62777, 63089, 63243, 63505, 63673, 63778, 63908, 64002, 64084, 64140, 64175, 64224, 64313};
|
|
for (i = 0; i<21; i++)
|
|
{
|
|
int rpms = i * 500;
|
|
|
|
printf("Setting RPM to %i hex as decimal %i\n", rpms, rpm_array[i]);
|
|
//printf("Setting RPM to %i\n", i);
|
|
|
|
unsigned char bytes[65];
|
|
unsigned long nnnnn = rpm_array[i];
|
|
//unsigned long nnnnn = i;
|
|
unsigned long xlong = 0;
|
|
for (int x = 0; x < 64; x++)
|
|
{
|
|
bytes[x] = 0x00;
|
|
}
|
|
bytes[3] = (nnnnn >> 8) & 0xFF;
|
|
bytes[2] = nnnnn & 0xFF;
|
|
|
|
//bytes[0] = (nnnnn >> 24) & 0xFF;
|
|
//bytes[1] = (nnnnn >> 16) & 0xFF;
|
|
//bytes[2] = (nnnnn >> 8) & 0xFF;
|
|
//bytes[3] = nnnnn & 0xFF;
|
|
if (handle)
|
|
{
|
|
d = libusb_interrupt_transfer(handle, ENDPOINT_OUT, bytes, sizeof(bytes), &len, 0);
|
|
}
|
|
|
|
sleep(4);
|
|
}
|
|
|
|
for (int x = 0; x < 65; x++)
|
|
{
|
|
bytes[x] = 0x00;
|
|
}
|
|
|
|
if (handle)
|
|
{
|
|
d = libusb_interrupt_transfer(handle, ENDPOINT_OUT, bytes, sizeof(bytes), &len, 0);
|
|
}
|
|
|
|
if (handle)
|
|
{
|
|
libusb_close(handle);
|
|
}
|
|
|
|
//set_rpms(dev, NULL);
|
|
|
|
libusb_free_device_list(devs, 1);
|
|
|
|
libusb_exit(NULL);
|
|
return r;
|
|
}
|