X-Git-Url: https://git.zerfleddert.de/cgi-bin/gitweb.cgi/hmcfgusb/blobdiff_plain/4cadd56df3b8ae13191061cd1daf162596ff481b..2a6eaefc7786a666d27c52a8e9bb0c1c4aeb2843:/hmcfgusb.c diff --git a/hmcfgusb.c b/hmcfgusb.c index 0bcb5ae..ce8c595 100644 --- a/hmcfgusb.c +++ b/hmcfgusb.c @@ -29,6 +29,7 @@ #include #include #include +#include #include #include "hexdump.h" @@ -139,13 +140,32 @@ static libusb_device_handle *hmcfgusb_find() { return NULL; } +int hmcfgusb_send_null_frame(struct hmcfgusb_dev *usbdev) +{ + int err; + int cnt; + + err = libusb_interrupt_transfer(usbdev->usb_devh, EP_OUT, NULL, 0, &cnt, USB_TIMEOUT); + if (err) { + fprintf(stderr, "Can't send data: %s\n", usb_strerror(err)); + return 0; + } + + return 1; +} + int hmcfgusb_send(struct hmcfgusb_dev *usbdev, unsigned char* send_data, int len, int done) { int err; int cnt; + struct timeval tv_start, tv_end; + int msec; - if (debug) + if (debug) { hexdump(send_data, len, "USB < "); + gettimeofday(&tv_start, NULL); + } + err = libusb_interrupt_transfer(usbdev->usb_devh, EP_OUT, send_data, len, &cnt, USB_TIMEOUT); if (err) { fprintf(stderr, "Can't send data: %s\n", usb_strerror(err)); @@ -153,13 +173,17 @@ int hmcfgusb_send(struct hmcfgusb_dev *usbdev, unsigned char* send_data, int len } if (done) { - err = libusb_interrupt_transfer(usbdev->usb_devh, EP_OUT, send_data, 0, &cnt, USB_TIMEOUT); - if (err) { - fprintf(stderr, "Can't send data: %s\n", usb_strerror(err)); + if (!hmcfgusb_send_null_frame(usbdev)) { return 0; } } + if (debug) { + gettimeofday(&tv_end, NULL); + msec = ((tv_end.tv_sec-tv_start.tv_sec)*1000)+((tv_end.tv_usec-tv_start.tv_usec)/1000); + fprintf(stderr, "send took %dms!\n", msec); + } + return 1; }