2 * xusb: Generic USB test program
3 * Copyright © 2009-2012 Pete Batard <pete@akeo.ie>
4 * Contributions to Mass Storage by Alan Stern.
6 * This library is free software; you can redistribute it and/or
7 * modify it under the terms of the GNU Lesser General Public
8 * License as published by the Free Software Foundation; either
9 * version 2.1 of the License, or (at your option) any later version.
11 * This library is distributed in the hope that it will be useful,
12 * but WITHOUT ANY WARRANTY; without even the implied warranty of
13 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
14 * Lesser General Public License for more details.
16 * You should have received a copy of the GNU Lesser General Public
17 * License along with this library; if not, write to the Free Software
18 * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA
30 #define msleep(msecs) Sleep(msecs)
33 #define msleep(msecs) usleep(1000*msecs)
46 // Future versions of libusbx will use usb_interface instead of interface
47 // in libusb_config_descriptor => catter for that
48 #define usb_interface interface
51 bool binary_dump = false;
52 bool extra_info = false;
53 const char* binary_name = NULL;
55 static int perr(char const *format, ...)
60 va_start (args, format);
61 r = vfprintf(stderr, format, args);
67 #define ERR_EXIT(errcode) do { perr(" %s\n", libusb_strerror((enum libusb_error)errcode)); return -1; } while (0)
68 #define CALL_CHECK(fcall) do { r=fcall; if (r < 0) ERR_EXIT(r); } while (0);
69 #define B(x) (((x)!=0)?1:0)
70 #define be_to_int32(buf) (((buf)[0]<<24)|((buf)[1]<<16)|((buf)[2]<<8)|(buf)[3])
73 #define REQUEST_SENSE_LENGTH 0x12
74 #define INQUIRY_LENGTH 0x24
75 #define READ_CAPACITY_LENGTH 0x08
77 // HID Class-Specific Requests values. See section 7.2 of the HID specifications
78 #define HID_GET_REPORT 0x01
79 #define HID_GET_IDLE 0x02
80 #define HID_GET_PROTOCOL 0x03
81 #define HID_SET_REPORT 0x09
82 #define HID_SET_IDLE 0x0A
83 #define HID_SET_PROTOCOL 0x0B
84 #define HID_REPORT_TYPE_INPUT 0x01
85 #define HID_REPORT_TYPE_OUTPUT 0x02
86 #define HID_REPORT_TYPE_FEATURE 0x03
88 // Mass Storage Requests values. See section 3 of the Bulk-Only Mass Storage Class specifications
89 #define BOMS_RESET 0xFF
90 #define BOMS_GET_MAX_LUN 0xFE
92 // Section 5.1: Command Block Wrapper (CBW)
93 struct command_block_wrapper {
94 uint8_t dCBWSignature[4];
96 uint32_t dCBWDataTransferLength;
103 // Section 5.2: Command Status Wrapper (CSW)
104 struct command_status_wrapper {
105 uint8_t dCSWSignature[4];
107 uint32_t dCSWDataResidue;
111 static uint8_t cdb_length[256] = {
112 // 0 1 2 3 4 5 6 7 8 9 A B C D E F
113 06,06,06,06,06,06,06,06,06,06,06,06,06,06,06,06, // 0
114 06,06,06,06,06,06,06,06,06,06,06,06,06,06,06,06, // 1
115 10,10,10,10,10,10,10,10,10,10,10,10,10,10,10,10, // 2
116 10,10,10,10,10,10,10,10,10,10,10,10,10,10,10,10, // 3
117 10,10,10,10,10,10,10,10,10,10,10,10,10,10,10,10, // 4
118 10,10,10,10,10,10,10,10,10,10,10,10,10,10,10,10, // 5
119 00,00,00,00,00,00,00,00,00,00,00,00,00,00,00,00, // 6
120 00,00,00,00,00,00,00,00,00,00,00,00,00,00,00,00, // 7
121 16,16,16,16,16,16,16,16,16,16,16,16,16,16,16,16, // 8
122 16,16,16,16,16,16,16,16,16,16,16,16,16,16,16,16, // 9
123 12,12,12,12,12,12,12,12,12,12,12,12,12,12,12,12, // A
124 12,12,12,12,12,12,12,12,12,12,12,12,12,12,12,12, // B
125 00,00,00,00,00,00,00,00,00,00,00,00,00,00,00,00, // C
126 00,00,00,00,00,00,00,00,00,00,00,00,00,00,00,00, // D
127 00,00,00,00,00,00,00,00,00,00,00,00,00,00,00,00, // E
128 00,00,00,00,00,00,00,00,00,00,00,00,00,00,00,00, // F
140 static void display_buffer_hex(unsigned char *buffer, unsigned size)
144 for (i=0; i<size; i+=16) {
145 printf("\n %08x ", i);
146 for(j=0,k=0; k<16; j++,k++) {
148 printf("%02x", buffer[i+j]);
155 for(j=0,k=0; k<16; j++,k++) {
157 if ((buffer[i+j] < 32) || (buffer[i+j] > 126)) {
160 printf("%c", buffer[i+j]);
168 static char* uuid_to_string(const uint8_t* uuid)
170 static char uuid_string[40];
171 if (uuid == NULL) return NULL;
172 sprintf(uuid_string, "{%02x%02x%02x%02x-%02x%02x-%02x%02x-%02x%02x-%02x%02x%02x%02x%02x%02x}",
173 uuid[0], uuid[1], uuid[2], uuid[3], uuid[4], uuid[5], uuid[6], uuid[7],
174 uuid[8], uuid[9], uuid[10], uuid[11], uuid[12], uuid[13], uuid[14], uuid[15]);
178 // The PS3 Controller is really a HID device that got its HID Report Descriptors
180 static int display_ps3_status(libusb_device_handle *handle)
183 uint8_t input_report[49];
184 uint8_t master_bt_address[8];
185 uint8_t device_bt_address[18];
187 // Get the controller's bluetooth address of its master device
188 CALL_CHECK(libusb_control_transfer(handle, LIBUSB_ENDPOINT_IN|LIBUSB_REQUEST_TYPE_CLASS|LIBUSB_RECIPIENT_INTERFACE,
189 HID_GET_REPORT, 0x03f5, 0, master_bt_address, sizeof(master_bt_address), 100));
190 printf("\nMaster's bluetooth address: %02X:%02X:%02X:%02X:%02X:%02X\n", master_bt_address[2], master_bt_address[3],
191 master_bt_address[4], master_bt_address[5], master_bt_address[6], master_bt_address[7]);
193 // Get the controller's bluetooth address
194 CALL_CHECK(libusb_control_transfer(handle, LIBUSB_ENDPOINT_IN|LIBUSB_REQUEST_TYPE_CLASS|LIBUSB_RECIPIENT_INTERFACE,
195 HID_GET_REPORT, 0x03f2, 0, device_bt_address, sizeof(device_bt_address), 100));
196 printf("\nMaster's bluetooth address: %02X:%02X:%02X:%02X:%02X:%02X\n", device_bt_address[4], device_bt_address[5],
197 device_bt_address[6], device_bt_address[7], device_bt_address[8], device_bt_address[9]);
199 // Get the status of the controller's buttons via its HID report
200 printf("\nReading PS3 Input Report...\n");
201 CALL_CHECK(libusb_control_transfer(handle, LIBUSB_ENDPOINT_IN|LIBUSB_REQUEST_TYPE_CLASS|LIBUSB_RECIPIENT_INTERFACE,
202 HID_GET_REPORT, (HID_REPORT_TYPE_INPUT<<8)|0x01, 0, input_report, sizeof(input_report), 1000));
203 switch(input_report[2]){ /** Direction pad plus start, select, and joystick buttons */
205 printf("\tSELECT pressed\n");
208 printf("\tLEFT 3 pressed\n");
211 printf("\tRIGHT 3 pressed\n");
214 printf("\tSTART presed\n");
217 printf("\tUP pressed\n");
220 printf("\tRIGHT pressed\n");
223 printf("\tDOWN pressed\n");
226 printf("\tLEFT pressed\n");
229 switch(input_report[3]){ /** Shapes plus top right and left buttons */
231 printf("\tLEFT 2 pressed\n");
234 printf("\tRIGHT 2 pressed\n");
237 printf("\tLEFT 1 pressed\n");
240 printf("\tRIGHT 1 presed\n");
243 printf("\tTRIANGLE pressed\n");
246 printf("\tCIRCLE pressed\n");
249 printf("\tCROSS pressed\n");
252 printf("\tSQUARE pressed\n");
255 printf("\tPS button: %d\n", input_report[4]);
256 printf("\tLeft Analog (X,Y): (%d,%d)\n", input_report[6], input_report[7]);
257 printf("\tRight Analog (X,Y): (%d,%d)\n", input_report[8], input_report[9]);
258 printf("\tL2 Value: %d\tR2 Value: %d\n", input_report[18], input_report[19]);
259 printf("\tL1 Value: %d\tR1 Value: %d\n", input_report[20], input_report[21]);
260 printf("\tRoll (x axis): %d Yaw (y axis): %d Pitch (z axis) %d\n",
261 //(((input_report[42] + 128) % 256) - 128),
262 (int8_t)(input_report[42]),
263 (int8_t)(input_report[44]),
264 (int8_t)(input_report[46]));
265 printf("\tAcceleration: %d\n\n", (int8_t)(input_report[48]));
268 // The XBOX Controller is really a HID device that got its HID Report Descriptors
269 // removed by Microsoft.
270 // Input/Output reports described at http://euc.jp/periphs/xbox-controller.ja.html
271 static int display_xbox_status(libusb_device_handle *handle)
274 uint8_t input_report[20];
275 printf("\nReading XBox Input Report...\n");
276 CALL_CHECK(libusb_control_transfer(handle, LIBUSB_ENDPOINT_IN|LIBUSB_REQUEST_TYPE_CLASS|LIBUSB_RECIPIENT_INTERFACE,
277 HID_GET_REPORT, (HID_REPORT_TYPE_INPUT<<8)|0x00, 0, input_report, 20, 1000));
278 printf(" D-pad: %02X\n", input_report[2]&0x0F);
279 printf(" Start:%d, Back:%d, Left Stick Press:%d, Right Stick Press:%d\n", B(input_report[2]&0x10), B(input_report[2]&0x20),
280 B(input_report[2]&0x40), B(input_report[2]&0x80));
281 // A, B, X, Y, Black, White are pressure sensitive
282 printf(" A:%d, B:%d, X:%d, Y:%d, White:%d, Black:%d\n", input_report[4], input_report[5],
283 input_report[6], input_report[7], input_report[9], input_report[8]);
284 printf(" Left Trigger: %d, Right Trigger: %d\n", input_report[10], input_report[11]);
285 printf(" Left Analog (X,Y): (%d,%d)\n", (int16_t)((input_report[13]<<8)|input_report[12]),
286 (int16_t)((input_report[15]<<8)|input_report[14]));
287 printf(" Right Analog (X,Y): (%d,%d)\n", (int16_t)((input_report[17]<<8)|input_report[16]),
288 (int16_t)((input_report[19]<<8)|input_report[18]));
292 static int set_xbox_actuators(libusb_device_handle *handle, uint8_t left, uint8_t right)
295 uint8_t output_report[6];
297 printf("\nWriting XBox Controller Output Report...\n");
299 memset(output_report, 0, sizeof(output_report));
300 output_report[1] = sizeof(output_report);
301 output_report[3] = left;
302 output_report[5] = right;
304 CALL_CHECK(libusb_control_transfer(handle, LIBUSB_ENDPOINT_OUT|LIBUSB_REQUEST_TYPE_CLASS|LIBUSB_RECIPIENT_INTERFACE,
305 HID_SET_REPORT, (HID_REPORT_TYPE_OUTPUT<<8)|0x00, 0, output_report, 06, 1000));
309 static int send_mass_storage_command(libusb_device_handle *handle, uint8_t endpoint, uint8_t lun,
310 uint8_t *cdb, uint8_t direction, int data_length, uint32_t *ret_tag)
312 static uint32_t tag = 1;
315 struct command_block_wrapper cbw;
321 if (endpoint & LIBUSB_ENDPOINT_IN) {
322 perr("send_mass_storage_command: cannot send command on IN endpoint\n");
326 cdb_len = cdb_length[cdb[0]];
327 if ((cdb_len == 0) || (cdb_len > sizeof(cbw.CBWCB))) {
328 perr("send_mass_storage_command: don't know how to handle this command (%02X, length %d)\n",
333 memset(&cbw, 0, sizeof(cbw));
334 cbw.dCBWSignature[0] = 'U';
335 cbw.dCBWSignature[1] = 'S';
336 cbw.dCBWSignature[2] = 'B';
337 cbw.dCBWSignature[3] = 'C';
340 cbw.dCBWDataTransferLength = data_length;
341 cbw.bmCBWFlags = direction;
343 // Subclass is 1 or 6 => cdb_len
344 cbw.bCBWCBLength = cdb_len;
345 memcpy(cbw.CBWCB, cdb, cdb_len);
349 // The transfer length must always be exactly 31 bytes.
350 r = libusb_bulk_transfer(handle, endpoint, (unsigned char*)&cbw, 31, &size, 1000);
351 if (r == LIBUSB_ERROR_PIPE) {
352 libusb_clear_halt(handle, endpoint);
355 } while ((r == LIBUSB_ERROR_PIPE) && (i<RETRY_MAX));
356 if (r != LIBUSB_SUCCESS) {
357 perr(" send_mass_storage_command: %s\n", libusb_strerror((enum libusb_error)r));
361 printf(" sent %d CDB bytes\n", cdb_len);
365 static int get_mass_storage_status(libusb_device_handle *handle, uint8_t endpoint, uint32_t expected_tag)
368 struct command_status_wrapper csw;
370 // The device is allowed to STALL this transfer. If it does, you have to
371 // clear the stall and try again.
374 r = libusb_bulk_transfer(handle, endpoint, (unsigned char*)&csw, 13, &size, 1000);
375 if (r == LIBUSB_ERROR_PIPE) {
376 libusb_clear_halt(handle, endpoint);
379 } while ((r == LIBUSB_ERROR_PIPE) && (i<RETRY_MAX));
380 if (r != LIBUSB_SUCCESS) {
381 perr(" get_mass_storage_status: %s\n", libusb_strerror((enum libusb_error)r));
385 perr(" get_mass_storage_status: received %d bytes (expected 13)\n", size);
388 if (csw.dCSWTag != expected_tag) {
389 perr(" get_mass_storage_status: mismatched tags (expected %08X, received %08X)\n",
390 expected_tag, csw.dCSWTag);
393 // For this test, we ignore the dCSWSignature check for validity...
394 printf(" Mass Storage Status: %02X (%s)\n", csw.bCSWStatus, csw.bCSWStatus?"FAILED":"Success");
395 if (csw.dCSWTag != expected_tag)
397 if (csw.bCSWStatus) {
398 // REQUEST SENSE is appropriate only if bCSWStatus is 1, meaning that the
399 // command failed somehow. Larger values (2 in particular) mean that
400 // the command couldn't be understood.
401 if (csw.bCSWStatus == 1)
402 return -2; // request Get Sense
407 // In theory we also should check dCSWDataResidue. But lots of devices
412 static void get_sense(libusb_device_handle *handle, uint8_t endpoint_in, uint8_t endpoint_out)
414 uint8_t cdb[16]; // SCSI Command Descriptor Block
416 uint32_t expected_tag;
420 printf("Request Sense:\n");
421 memset(sense, 0, sizeof(sense));
422 memset(cdb, 0, sizeof(cdb));
423 cdb[0] = 0x03; // Request Sense
424 cdb[4] = REQUEST_SENSE_LENGTH;
426 send_mass_storage_command(handle, endpoint_out, 0, cdb, LIBUSB_ENDPOINT_IN, REQUEST_SENSE_LENGTH, &expected_tag);
427 libusb_bulk_transfer(handle, endpoint_in, (unsigned char*)&sense, REQUEST_SENSE_LENGTH, &size, 1000);
428 printf(" received %d bytes\n", size);
430 if ((sense[0] != 0x70) && (sense[0] != 0x71)) {
431 perr(" ERROR No sense data\n");
433 perr(" ERROR Sense: %02X %02X %02X\n", sense[2]&0x0F, sense[12], sense[13]);
435 // Strictly speaking, the get_mass_storage_status() call should come
436 // before these perr() lines. If the status is nonzero then we must
437 // assume there's no data in the buffer. For xusb it doesn't matter.
438 get_mass_storage_status(handle, endpoint_in, expected_tag);
441 // Mass Storage device to test bulk transfers (non destructive test)
442 static int test_mass_storage(libusb_device_handle *handle, uint8_t endpoint_in, uint8_t endpoint_out)
446 uint32_t expected_tag;
447 uint32_t i, max_lba, block_size;
449 uint8_t cdb[16]; // SCSI Command Descriptor Block
451 char vid[9], pid[9], rev[5];
455 printf("Reading Max LUN:\n");
456 r = libusb_control_transfer(handle, LIBUSB_ENDPOINT_IN|LIBUSB_REQUEST_TYPE_CLASS|LIBUSB_RECIPIENT_INTERFACE,
457 BOMS_GET_MAX_LUN, 0, 0, &lun, 1, 1000);
458 // Some devices send a STALL instead of the actual value.
459 // In such cases we should set lun to 0.
463 perr(" Failed: %s", libusb_strerror((enum libusb_error)r));
465 printf(" Max LUN = %d\n", lun);
468 printf("Sending Inquiry:\n");
469 memset(buffer, 0, sizeof(buffer));
470 memset(cdb, 0, sizeof(cdb));
471 cdb[0] = 0x12; // Inquiry
472 cdb[4] = INQUIRY_LENGTH;
474 send_mass_storage_command(handle, endpoint_out, lun, cdb, LIBUSB_ENDPOINT_IN, INQUIRY_LENGTH, &expected_tag);
475 CALL_CHECK(libusb_bulk_transfer(handle, endpoint_in, (unsigned char*)&buffer, INQUIRY_LENGTH, &size, 1000));
476 printf(" received %d bytes\n", size);
477 // The following strings are not zero terminated
478 for (i=0; i<8; i++) {
479 vid[i] = buffer[8+i];
480 pid[i] = buffer[16+i];
481 rev[i/2] = buffer[32+i/2]; // instead of another loop
486 printf(" VID:PID:REV \"%8s\":\"%8s\":\"%4s\"\n", vid, pid, rev);
487 if (get_mass_storage_status(handle, endpoint_in, expected_tag) == -2) {
488 get_sense(handle, endpoint_in, endpoint_out);
492 printf("Reading Capacity:\n");
493 memset(buffer, 0, sizeof(buffer));
494 memset(cdb, 0, sizeof(cdb));
495 cdb[0] = 0x25; // Read Capacity
497 send_mass_storage_command(handle, endpoint_out, lun, cdb, LIBUSB_ENDPOINT_IN, READ_CAPACITY_LENGTH, &expected_tag);
498 CALL_CHECK(libusb_bulk_transfer(handle, endpoint_in, (unsigned char*)&buffer, READ_CAPACITY_LENGTH, &size, 1000));
499 printf(" received %d bytes\n", size);
500 max_lba = be_to_int32(&buffer[0]);
501 block_size = be_to_int32(&buffer[4]);
502 device_size = ((double)(max_lba+1))*block_size/(1024*1024*1024);
503 printf(" Max LBA: %08X, Block Size: %08X (%.2f GB)\n", max_lba, block_size, device_size);
504 if (get_mass_storage_status(handle, endpoint_in, expected_tag) == -2) {
505 get_sense(handle, endpoint_in, endpoint_out);
508 data = (unsigned char*) calloc(1, block_size);
510 perr(" unable to allocate data buffer\n");
515 printf("Attempting to read %d bytes:\n", block_size);
516 memset(cdb, 0, sizeof(cdb));
518 cdb[0] = 0x28; // Read(10)
519 cdb[8] = 0x01; // 1 block
521 send_mass_storage_command(handle, endpoint_out, lun, cdb, LIBUSB_ENDPOINT_IN, block_size, &expected_tag);
522 libusb_bulk_transfer(handle, endpoint_in, data, block_size, &size, 5000);
523 printf(" READ: received %d bytes\n", size);
524 if (get_mass_storage_status(handle, endpoint_in, expected_tag) == -2) {
525 get_sense(handle, endpoint_in, endpoint_out);
527 display_buffer_hex(data, size);
528 if ((binary_dump) && ((fd = fopen(binary_name, "w")) != NULL)) {
529 if (fwrite(data, 1, (size_t)size, fd) != (unsigned int)size) {
530 perr(" unable to write binary data\n");
541 static int get_hid_record_size(uint8_t *hid_report_descriptor, int size, int type)
545 int record_size[3] = {0, 0, 0};
546 int nb_bits = 0, nb_items = 0;
547 bool found_record_marker;
549 found_record_marker = false;
550 for (i = hid_report_descriptor[0]+1; i < size; i += offset) {
551 offset = (hid_report_descriptor[i]&0x03) + 1;
554 switch (hid_report_descriptor[i] & 0xFC) {
555 case 0x74: // bitsize
556 nb_bits = hid_report_descriptor[i+1];
560 for (j=1; j<offset; j++) {
561 nb_items = ((uint32_t)hid_report_descriptor[i+j]) << (8*(j-1));
565 found_record_marker = true;
569 found_record_marker = true;
572 case 0xb0: // feature
573 found_record_marker = true;
576 case 0xC0: // end of collection
583 if (found_record_marker) {
584 found_record_marker = false;
585 record_size[j] += nb_items*nb_bits;
588 if ((type < HID_REPORT_TYPE_INPUT) || (type > HID_REPORT_TYPE_FEATURE)) {
591 return (record_size[type - HID_REPORT_TYPE_INPUT]+7)/8;
595 static int test_hid(libusb_device_handle *handle, uint8_t endpoint_in)
597 int r, size, descriptor_size;
598 uint8_t hid_report_descriptor[256];
599 uint8_t *report_buffer;
602 printf("\nReading HID Report Descriptors:\n");
603 descriptor_size = libusb_control_transfer(handle, LIBUSB_ENDPOINT_IN|LIBUSB_REQUEST_TYPE_STANDARD|LIBUSB_RECIPIENT_INTERFACE,
604 LIBUSB_REQUEST_GET_DESCRIPTOR, LIBUSB_DT_REPORT<<8, 0, hid_report_descriptor, sizeof(hid_report_descriptor), 1000);
605 if (descriptor_size < 0) {
609 display_buffer_hex(hid_report_descriptor, descriptor_size);
610 if ((binary_dump) && ((fd = fopen(binary_name, "w")) != NULL)) {
611 if (fwrite(hid_report_descriptor, 1, descriptor_size, fd) != descriptor_size) {
612 printf(" Error writing descriptor to file\n");
617 size = get_hid_record_size(hid_report_descriptor, descriptor_size, HID_REPORT_TYPE_FEATURE);
619 printf("\nSkipping Feature Report readout (None detected)\n");
621 report_buffer = (uint8_t*) calloc(size, 1);
622 if (report_buffer == NULL) {
626 printf("\nReading Feature Report (length %d)...\n", size);
627 r = libusb_control_transfer(handle, LIBUSB_ENDPOINT_IN|LIBUSB_REQUEST_TYPE_CLASS|LIBUSB_RECIPIENT_INTERFACE,
628 HID_GET_REPORT, (HID_REPORT_TYPE_FEATURE<<8)|0, 0, report_buffer, (uint16_t)size, 5000);
630 display_buffer_hex(report_buffer, size);
633 case LIBUSB_ERROR_NOT_FOUND:
634 printf(" No Feature Report available for this device\n");
636 case LIBUSB_ERROR_PIPE:
637 printf(" Detected stall - resetting pipe...\n");
638 libusb_clear_halt(handle, 0);
641 printf(" Error: %s\n", libusb_strerror((enum libusb_error)r));
648 size = get_hid_record_size(hid_report_descriptor, descriptor_size, HID_REPORT_TYPE_INPUT);
650 printf("\nSkipping Input Report readout (None detected)\n");
652 report_buffer = (uint8_t*) calloc(size, 1);
653 if (report_buffer == NULL) {
657 printf("\nReading Input Report (length %d)...\n", size);
658 r = libusb_control_transfer(handle, LIBUSB_ENDPOINT_IN|LIBUSB_REQUEST_TYPE_CLASS|LIBUSB_RECIPIENT_INTERFACE,
659 HID_GET_REPORT, (HID_REPORT_TYPE_INPUT<<8)|0x00, 0, report_buffer, (uint16_t)size, 5000);
661 display_buffer_hex(report_buffer, size);
664 case LIBUSB_ERROR_TIMEOUT:
665 printf(" Timeout! Please make sure you act on the device within the 5 seconds allocated...\n");
667 case LIBUSB_ERROR_PIPE:
668 printf(" Detected stall - resetting pipe...\n");
669 libusb_clear_halt(handle, 0);
672 printf(" Error: %s\n", libusb_strerror((enum libusb_error)r));
677 // Attempt a bulk read from endpoint 0 (this should just return a raw input report)
678 printf("\nTesting interrupt read using endpoint %02X...\n", endpoint_in);
679 r = libusb_interrupt_transfer(handle, endpoint_in, report_buffer, size, &size, 5000);
681 display_buffer_hex(report_buffer, size);
683 printf(" %s\n", libusb_strerror((enum libusb_error)r));
691 // Read the MS WinUSB Feature Descriptors, that are used on Windows 8 for automated driver installation
692 static void read_ms_winsub_feature_descriptors(libusb_device_handle *handle, uint8_t bRequest, int iface_number)
694 #define MAX_OS_FD_LENGTH 256
696 uint8_t os_desc[MAX_OS_FD_LENGTH];
698 void* le_type_punning_IS_fine;
703 uint16_t header_size;
705 {"Extended Compat ID", LIBUSB_RECIPIENT_DEVICE, 0x0004, 0x10},
706 {"Extended Properties", LIBUSB_RECIPIENT_INTERFACE, 0x0005, 0x0A}
709 if (iface_number < 0) return;
711 for (i=0; i<2; i++) {
712 printf("\nReading %s OS Feature Descriptor (wIndex = 0x%04d):\n", os_fd[i].desc, os_fd[i].index);
714 // Read the header part
715 r = libusb_control_transfer(handle, (uint8_t)(LIBUSB_ENDPOINT_IN|LIBUSB_REQUEST_TYPE_VENDOR|os_fd[i].recipient),
716 bRequest, (uint16_t)(((iface_number)<< 8)|0x00), os_fd[i].index, os_desc, os_fd[i].header_size, 1000);
717 if (r < os_fd[i].header_size) {
718 perr(" Failed: %s", (r<0)?libusb_strerror((enum libusb_error)r):"header size is too small");
721 le_type_punning_IS_fine = (void*)os_desc;
722 length = *((uint32_t*)le_type_punning_IS_fine);
723 if (length > MAX_OS_FD_LENGTH) {
724 length = MAX_OS_FD_LENGTH;
727 // Read the full feature descriptor
728 r = libusb_control_transfer(handle, (uint8_t)(LIBUSB_ENDPOINT_IN|LIBUSB_REQUEST_TYPE_VENDOR|os_fd[i].recipient),
729 bRequest, (uint16_t)(((iface_number)<< 8)|0x00), os_fd[i].index, os_desc, (uint16_t)length, 1000);
731 perr(" Failed: %s", libusb_strerror((enum libusb_error)r));
734 display_buffer_hex(os_desc, r);
739 static void print_device_cap(struct libusb_bos_dev_capability_descriptor *dev_cap)
741 switch(dev_cap->bDevCapabilityType) {
742 case LIBUSB_BT_USB_2_0_EXTENSION: {
743 struct libusb_usb_2_0_extension_descriptor *usb_2_0_ext = NULL;
744 libusb_get_usb_2_0_extension_descriptor(NULL, dev_cap, &usb_2_0_ext);
746 printf(" USB 2.0 extension:\n");
747 printf(" attributes : %02X\n", usb_2_0_ext->bmAttributes);
748 libusb_free_usb_2_0_extension_descriptor(usb_2_0_ext);
752 case LIBUSB_BT_SS_USB_DEVICE_CAPABILITY: {
753 struct libusb_ss_usb_device_capability_descriptor *ss_usb_device_cap = NULL;
754 libusb_get_ss_usb_device_capability_descriptor(NULL, dev_cap, &ss_usb_device_cap);
755 if (ss_usb_device_cap) {
756 printf(" USB 3.0 capabilities:\n");
757 printf(" attributes : %02X\n", ss_usb_device_cap->bmAttributes);
758 printf(" supported speeds : %04X\n", ss_usb_device_cap->wSpeedSupported);
759 printf(" supported functionality: %02X\n", ss_usb_device_cap->bFunctionalitySupport);
760 libusb_free_ss_usb_device_capability_descriptor(ss_usb_device_cap);
764 case LIBUSB_BT_CONTAINER_ID: {
765 struct libusb_container_id_descriptor *container_id = NULL;
766 libusb_get_container_id_descriptor(NULL, dev_cap, &container_id);
768 printf(" Container ID:\n %s\n", uuid_to_string(container_id->ContainerID));
769 libusb_free_container_id_descriptor(container_id);
774 printf(" Unknown BOS device capability %02x:\n", dev_cap->bDevCapabilityType);
778 static int test_device(uint16_t vid, uint16_t pid)
780 libusb_device_handle *handle;
782 uint8_t bus, port_path[8];
783 struct libusb_bos_descriptor *bos_desc;
784 struct libusb_config_descriptor *conf_desc;
785 const struct libusb_endpoint_descriptor *endpoint;
787 int iface, nb_ifaces, first_iface = -1;
788 // For attaching/detaching the kernel driver, if needed
789 int iface_detached = -1;
790 struct libusb_device_descriptor dev_desc;
791 const char* speed_name[5] = { "Unknown", "1.5 Mbit/s (USB LowSpeed)", "12 Mbit/s (USB FullSpeed)",
792 "480 Mbit/s (USB HighSpeed)", "5000 Mbit/s (USB SuperSpeed)"};
794 uint8_t string_index[3]; // indexes of the string descriptors
795 uint8_t endpoint_in = 0, endpoint_out = 0; // default IN and OUT endpoints
797 printf("Opening device %04X:%04X...\n", vid, pid);
798 handle = libusb_open_device_with_vid_pid(NULL, vid, pid);
800 if (handle == NULL) {
805 dev = libusb_get_device(handle);
806 bus = libusb_get_bus_number(dev);
808 r = libusb_get_port_numbers(dev, port_path, sizeof(port_path));
810 printf("\nDevice properties:\n");
811 printf(" bus number: %d\n", bus);
812 printf(" port path: %d", port_path[0]);
813 for (i=1; i<r; i++) {
814 printf("->%d", port_path[i]);
816 printf(" (from root hub)\n");
818 r = libusb_get_device_speed(dev);
819 if ((r<0) || (r>4)) r=0;
820 printf(" speed: %s\n", speed_name[r]);
823 printf("\nReading device descriptor:\n");
824 CALL_CHECK(libusb_get_device_descriptor(dev, &dev_desc));
825 printf(" length: %d\n", dev_desc.bLength);
826 printf(" device class: %d\n", dev_desc.bDeviceClass);
827 printf(" S/N: %d\n", dev_desc.iSerialNumber);
828 printf(" VID:PID: %04X:%04X\n", dev_desc.idVendor, dev_desc.idProduct);
829 printf(" bcdDevice: %04X\n", dev_desc.bcdDevice);
830 printf(" iMan:iProd:iSer: %d:%d:%d\n", dev_desc.iManufacturer, dev_desc.iProduct, dev_desc.iSerialNumber);
831 printf(" nb confs: %d\n", dev_desc.bNumConfigurations);
832 // Copy the string descriptors for easier parsing
833 string_index[0] = dev_desc.iManufacturer;
834 string_index[1] = dev_desc.iProduct;
835 string_index[2] = dev_desc.iSerialNumber;
837 printf("\nReading BOS descriptor: ");
838 if (libusb_get_bos_descriptor(handle, &bos_desc) == LIBUSB_SUCCESS) {
839 printf("%d caps\n", bos_desc->bNumDeviceCaps);
840 for (i = 0; i < bos_desc->bNumDeviceCaps; i++)
841 print_device_cap(bos_desc->dev_capability[i]);
842 libusb_free_bos_descriptor(bos_desc);
844 printf("no descriptor\n");
847 printf("\nReading first configuration descriptor:\n");
848 CALL_CHECK(libusb_get_config_descriptor(dev, 0, &conf_desc));
849 nb_ifaces = conf_desc->bNumInterfaces;
850 printf(" nb interfaces: %d\n", nb_ifaces);
852 first_iface = conf_desc->usb_interface[0].altsetting[0].bInterfaceNumber;
853 for (i=0; i<nb_ifaces; i++) {
854 printf(" interface[%d]: id = %d\n", i,
855 conf_desc->usb_interface[i].altsetting[0].bInterfaceNumber);
856 for (j=0; j<conf_desc->usb_interface[i].num_altsetting; j++) {
857 printf("interface[%d].altsetting[%d]: num endpoints = %d\n",
858 i, j, conf_desc->usb_interface[i].altsetting[j].bNumEndpoints);
859 printf(" Class.SubClass.Protocol: %02X.%02X.%02X\n",
860 conf_desc->usb_interface[i].altsetting[j].bInterfaceClass,
861 conf_desc->usb_interface[i].altsetting[j].bInterfaceSubClass,
862 conf_desc->usb_interface[i].altsetting[j].bInterfaceProtocol);
863 if ( (conf_desc->usb_interface[i].altsetting[j].bInterfaceClass == LIBUSB_CLASS_MASS_STORAGE)
864 && ( (conf_desc->usb_interface[i].altsetting[j].bInterfaceSubClass == 0x01)
865 || (conf_desc->usb_interface[i].altsetting[j].bInterfaceSubClass == 0x06) )
866 && (conf_desc->usb_interface[i].altsetting[j].bInterfaceProtocol == 0x50) ) {
867 // Mass storage devices that can use basic SCSI commands
868 test_mode = USE_SCSI;
870 for (k=0; k<conf_desc->usb_interface[i].altsetting[j].bNumEndpoints; k++) {
871 struct libusb_ss_endpoint_companion_descriptor *ep_comp = NULL;
872 endpoint = &conf_desc->usb_interface[i].altsetting[j].endpoint[k];
873 printf(" endpoint[%d].address: %02X\n", k, endpoint->bEndpointAddress);
874 // Use the first interrupt or bulk IN/OUT endpoints as default for testing
875 if ((endpoint->bmAttributes & LIBUSB_TRANSFER_TYPE_MASK) & (LIBUSB_TRANSFER_TYPE_BULK | LIBUSB_TRANSFER_TYPE_INTERRUPT)) {
876 if (endpoint->bEndpointAddress & LIBUSB_ENDPOINT_IN) {
878 endpoint_in = endpoint->bEndpointAddress;
881 endpoint_out = endpoint->bEndpointAddress;
884 printf(" max packet size: %04X\n", endpoint->wMaxPacketSize);
885 printf(" polling interval: %02X\n", endpoint->bInterval);
886 libusb_get_ss_endpoint_companion_descriptor(NULL, endpoint, &ep_comp);
888 printf(" max burst: %02X (USB 3.0)\n", ep_comp->bMaxBurst);
889 printf(" bytes per interval: %04X (USB 3.0)\n", ep_comp->wBytesPerInterval);
890 libusb_free_ss_endpoint_companion_descriptor(ep_comp);
895 libusb_free_config_descriptor(conf_desc);
897 for (iface = 0; iface < nb_ifaces; iface++)
899 printf("\nClaiming interface %d...\n", iface);
900 r = libusb_claim_interface(handle, iface);
901 if ((r != LIBUSB_SUCCESS) && libusb_has_capability(LIBUSB_CAP_SUPPORTS_DETACH_KERNEL_DRIVER)
902 && (libusb_kernel_driver_active(handle, iface) > 0)) {
903 // Try to detach the kernel driver
904 perr(" A kernel driver is active, trying to detach it...\n");
905 r = libusb_detach_kernel_driver(handle, iface);
906 if (r == LIBUSB_SUCCESS) {
907 iface_detached = iface;
908 printf(" Claiming interface again...\n");
909 r = libusb_claim_interface(handle, iface);
912 if (r != LIBUSB_SUCCESS) {
917 printf("\nReading string descriptors:\n");
918 for (i=0; i<3; i++) {
919 if (string_index[i] == 0) {
922 if (libusb_get_string_descriptor_ascii(handle, string_index[i], (unsigned char*)string, 128) >= 0) {
923 printf(" String (0x%02X): \"%s\"\n", string_index[i], string);
926 // Read the OS String Descriptor
927 if (libusb_get_string_descriptor_ascii(handle, 0xEE, (unsigned char*)string, 128) >= 0) {
928 printf(" String (0x%02X): \"%s\"\n", 0xEE, string);
929 // If this is a Microsoft OS String Descriptor,
930 // attempt to read the WinUSB extended Feature Descriptors
931 if (strncmp(string, "MSFT100", 7) == 0)
932 read_ms_winsub_feature_descriptors(handle, string[7], first_iface);
937 CALL_CHECK(display_ps3_status(handle));
940 CALL_CHECK(display_xbox_status(handle));
941 CALL_CHECK(set_xbox_actuators(handle, 128, 222));
943 CALL_CHECK(set_xbox_actuators(handle, 0, 0));
946 test_hid(handle, endpoint_in);
949 CALL_CHECK(test_mass_storage(handle, endpoint_in, endpoint_out));
955 for (iface = 0; iface<nb_ifaces; iface++) {
956 printf("Releasing interface %d...\n", iface);
957 libusb_release_interface(handle, iface);
960 if (iface_detached >= 0) {
961 printf("Re-attaching kernel driver...\n");
962 libusb_attach_kernel_driver(handle, iface_detached);
965 printf("Closing device...\n");
966 libusb_close(handle);
971 int main(int argc, char** argv)
973 bool show_help = false;
974 bool debug_mode = false;
975 const struct libusb_version* version;
978 unsigned tmp_vid, tmp_pid;
979 uint16_t endian_test = 0xBE00;
980 char* error_lang = NULL;
982 // Default to generic, expecting VID:PID
985 test_mode = USE_GENERIC;
987 if (((uint8_t*)&endian_test)[0] == 0xBE) {
988 printf("Despite their natural superiority for end users, big endian\n"
989 "CPUs are not supported with this program, sorry.\n");
994 for (j = 1; j<argc; j++) {
995 arglen = strlen(argv[j]);
996 if ( ((argv[j][0] == '-') || (argv[j][0] == '/'))
1006 if ((j+1 >= argc) || (argv[j+1][0] == '-') || (argv[j+1][0] == '/')) {
1007 printf(" Option -b requires a file name\n");
1010 binary_name = argv[++j];
1014 if ((j+1 >= argc) || (argv[j+1][0] == '-') || (argv[j+1][0] == '/')) {
1015 printf(" Option -l requires an ISO 639-1 language parameter\n");
1018 error_lang = argv[++j];
1021 // OLIMEX ARM-USB-TINY JTAG, 2 channel composite device - 2 interfaces
1028 // Generic 2 GB USB Key (SCSI Transparent/Bulk Only) - 1 interface
1034 // The following tests will force VID:PID if already provided
1036 // Sony PS3 Controller - 1 interface
1039 test_mode = USE_PS3;
1042 // Microsoft Sidewinder Precision Pro Joystick - 1 HID interface
1045 test_mode = USE_HID;
1048 // Microsoft XBox Controller Type S - 1 interface
1051 test_mode = USE_XBOX;
1058 for (i=0; i<arglen; i++) {
1059 if (argv[j][i] == ':')
1063 if (sscanf(argv[j], "%x:%x" , &tmp_vid, &tmp_pid) != 2) {
1064 printf(" Please specify VID & PID as \"vid:pid\" in hexadecimal format\n");
1067 VID = (uint16_t)tmp_vid;
1068 PID = (uint16_t)tmp_pid;
1076 if ((show_help) || (argc == 1) || (argc > 7)) {
1077 printf("usage: %s [-h] [-d] [-i] [-k] [-b file] [-l lang] [-j] [-x] [-s] [-p] [vid:pid]\n", argv[0]);
1078 printf(" -h : display usage\n");
1079 printf(" -d : enable debug output\n");
1080 printf(" -i : print topology and speed info\n");
1081 printf(" -j : test composite FTDI based JTAG device\n");
1082 printf(" -k : test Mass Storage device\n");
1083 printf(" -b file : dump Mass Storage data to file 'file'\n");
1084 printf(" -p : test Sony PS3 SixAxis controller\n");
1085 printf(" -s : test Microsoft Sidewinder Precision Pro (HID)\n");
1086 printf(" -x : test Microsoft XBox Controller Type S\n");
1087 printf(" -l lang : language to report errors in (ISO 639-1)\n");
1088 printf("If only the vid:pid is provided, xusb attempts to run the most appropriate test\n");
1092 version = libusb_get_version();
1093 printf("Using libusbx v%d.%d.%d.%d\n\n", version->major, version->minor, version->micro, version->nano);
1094 r = libusb_init(NULL);
1098 libusb_set_debug(NULL, debug_mode?LIBUSB_LOG_LEVEL_DEBUG:LIBUSB_LOG_LEVEL_INFO);
1099 if (error_lang != NULL) {
1100 r = libusb_setlocale(error_lang);
1102 printf("Invalid or unsupported locale '%s': %s\n", error_lang, libusb_strerror((enum libusb_error)r));
1105 test_device(VID, PID);