83 lines
2.3 KiB
C
83 lines
2.3 KiB
C
|
#include <stdio.h>
|
||
|
|
#include <string.h>
|
||
|
|
#include <sys/types.h>
|
||
|
|
#include <sys/stat.h>
|
||
|
|
#include <sys/ioctl.h>
|
||
|
|
#include <fcntl.h>
|
||
|
|
#include <linux/ioctl.h>
|
||
|
|
#include <linux/usbdevice_fs.h>
|
||
|
|
#include <libusb-1.0/libusb.h>
|
||
|
|
|
||
|
|
// Template for control messages, obtained through packet capture
|
||
|
|
unsigned char *CMD = "\xfd\x00\x16M\r\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00";
|
||
|
|
|
||
|
|
|
||
|
|
int main(int argc, char **argv) {
|
||
|
|
uint8_t cmd[64];
|
||
|
|
memcpy(cmd, CMD, 64);
|
||
|
|
struct usbdevfs_ioctl command;
|
||
|
|
libusb_context *ctx = NULL;
|
||
|
|
|
||
|
|
//
|
||
|
|
// Find and open the device
|
||
|
|
//
|
||
|
|
libusb_init(&ctx);
|
||
|
|
if (!ctx) {
|
||
|
|
perror("failed to initialize libusb");
|
||
|
|
return 1;
|
||
|
|
}
|
||
|
|
|
||
|
|
libusb_device_handle *devh = libusb_open_device_with_vid_pid(ctx, 0x0c2e, 0x0b07);
|
||
|
|
if (!devh) {
|
||
|
|
devh = libusb_open_device_with_vid_pid(ctx, 0x0c2e, 0x0b01);
|
||
|
|
if (!devh) {
|
||
|
|
perror("failed to open device");
|
||
|
|
return 1;
|
||
|
|
}
|
||
|
|
}
|
||
|
|
libusb_device *dev = libusb_get_device(devh);
|
||
|
|
if (!dev) {
|
||
|
|
perror("failed to get device info");
|
||
|
|
return 1;
|
||
|
|
}
|
||
|
|
|
||
|
|
//
|
||
|
|
// Disconnect usbhid driver from both device interfaces
|
||
|
|
//
|
||
|
|
char usbdevfs[32];
|
||
|
|
snprintf(usbdevfs, 32, "/dev/bus/usb/%03d/%03d", libusb_get_bus_number(dev), libusb_get_device_address(dev));
|
||
|
|
// usbdevfs/ioctl inspired from
|
||
|
|
// https://www.linuxquestions.org/questions/linux-hardware-18/how-to-unclaim-usb-device-558138/#post3406986
|
||
|
|
int fd = open(usbdevfs,O_RDWR);
|
||
|
|
if (fd < 1) {
|
||
|
|
perror("failed to open usbdevfs file");
|
||
|
|
return 1;
|
||
|
|
}
|
||
|
|
for (uint8_t i = 0; i < 2; ++i) {
|
||
|
|
command.ifno = i;
|
||
|
|
command.ioctl_code = USBDEVFS_DISCONNECT;
|
||
|
|
command.data = NULL;
|
||
|
|
int ret = ioctl(fd, USBDEVFS_IOCTL, &command);
|
||
|
|
if (ret < 0) {
|
||
|
|
perror("failed to unclaim USB interface from usbhid");
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
//
|
||
|
|
// Prepare and send a message on the control channel for each config argument
|
||
|
|
//
|
||
|
|
for (int i = 1; i < argc; ++i) {
|
||
|
|
memset(cmd+5, 0, 59);
|
||
|
|
cmd[1] = strlen(argv[i])+3;
|
||
|
|
memcpy(cmd+5, argv[i], strlen(argv[i]));
|
||
|
|
libusb_control_transfer(devh, 0x21, 0x09, 0x02fd, 1, cmd, 64, 0);
|
||
|
|
}
|
||
|
|
|
||
|
|
//
|
||
|
|
// Cleanup
|
||
|
|
//
|
||
|
|
libusb_release_interface(devh, 1);
|
||
|
|
libusb_close(devh);
|
||
|
|
libusb_exit(ctx);
|
||
|
|
}
|