34d0d1db
pifou
seance 1
|
1
2
3
4
|
#include <libusb-1.0/libusb.h>
#include <stdio.h>
#include <stdlib.h>
|
08e49fd9
pifou
Seance 2
|
5
6
|
// gcc file.c -l usb-1.0
|
34d0d1db
pifou
seance 1
|
7
8
9
10
11
12
13
14
15
16
17
18
19
|
int main(){
// init
libusb_context *context;
int status = libusb_init(&context);
if(status != 0){perror("libusb_init"); exit(-1);}
// devices list
libusb_device **devices;
ssize_t devices_count = libusb_get_device_list(context, &devices);
if(devices_count < 0){perror("libusb_get_device_list"); exit(-1);}
for(int i=0; i<devices_count; i++){
libusb_device *device = devices[i];
|
08e49fd9
pifou
Seance 2
|
20
21
22
23
24
25
26
27
28
29
|
// device description
struct libusb_device_descriptor desc;
int status = libusb_get_device_descriptor(device, &desc);
if(status != 0) continue;
// search for device
if(desc.idVendor != 0x0951
|| desc.idProduct != 0x01666)
continue;
|
34d0d1db
pifou
seance 1
|
30
31
|
// open connection
libusb_device_handle *handle;
|
08e49fd9
pifou
Seance 2
|
32
33
34
35
36
37
38
39
|
status = libusb_open(device, &handle);
if(status != 0){ perror("libusb_open"); exit(-1); }
// prepare config
struct libusb_config_descriptor *config_desc;
status = libusb_get_config_descriptor(device, 0, &config_desc);
if(status != 0){ perror("libusb_get_config_descriptor"); exit(-1); }
int configuration = config_desc->bConfigurationValue;
|
34d0d1db
pifou
seance 1
|
40
41
|
// detach kernel
|
08e49fd9
pifou
Seance 2
|
42
43
44
45
46
47
48
49
|
for(int j=0; j<config_desc->bNumInterfaces; j++){
for(int k=0; k<config_desc->interface[j].num_altsetting; k++){
int interface = config_desc->interface[j].altsetting[k].bInterfaceNumber;
if(libusb_kernel_driver_active(handle, interface)){
status = libusb_detach_kernel_driver(handle, interface);
if(status != 0){ perror("libusb_detach_kernel_driver"); exit(-1); }
}
}
|
34d0d1db
pifou
seance 1
|
50
|
}
|
08e49fd9
pifou
Seance 2
|
51
|
|
34d0d1db
pifou
seance 1
|
52
|
// use config
|
34d0d1db
pifou
seance 1
|
53
|
status = libusb_set_configuration(handle, configuration);
|
08e49fd9
pifou
Seance 2
|
54
55
56
57
58
59
60
61
62
63
|
if(status != 0){ perror("libusb_set_configuration"); exit(-1); }
// claim interfaces
for(int j=0; j<config_desc->bNumInterfaces; j++){
for(int k=0; k<config_desc->interface[j].num_altsetting; k++){
int interface = config_desc->interface[j].altsetting[k].bInterfaceNumber;
status = libusb_claim_interface(handle, interface);
if(status != 0){ perror("libusb_claim_interface"); exit(-1); }
}
}
|
34d0d1db
pifou
seance 1
|
64
65
|
/* ... some code ... */
|
08e49fd9
pifou
Seance 2
|
66
|
// TODO endpoints
|
34d0d1db
pifou
seance 1
|
67
|
|
08e49fd9
pifou
Seance 2
|
68
69
70
71
72
73
74
75
76
77
78
|
// release interfaces
for(int j=0; j<config_desc->bNumInterfaces; j++){
for(int k=0; k<config_desc->interface[j].num_altsetting; k++){
int interface = config_desc->interface[j].altsetting[k].bInterfaceNumber;
status = libusb_release_interface(handle, interface);
if(status != 0){ perror("libusb_release_interface"); exit(-1); }
}
}
// free config
libusb_free_config_descriptor(config_desc);
|
34d0d1db
pifou
seance 1
|
79
80
81
82
83
84
85
86
|
// close connection
libusb_close(handle);
}
libusb_free_device_list(devices, 1);
libusb_exit(context);
}
|