+/* FS20PCS libusb-driver
+ *
+ * Copyright (c) 2013 Michael Gernoth <michael@gernoth.net>
+ *
+ * Permission is hereby granted, free of charge, to any person obtaining a copy
+ * of this software and associated documentation files (the "Software"), to
+ * deal in the Software without restriction, including without limitation the
+ * rights to use, copy, modify, merge, publish, distribute, sublicense, and/or
+ * sell copies of the Software, and to permit persons to whom the Software is
+ * furnished to do so, subject to the following conditions:
+ *
+ * The above copyright notice and this permission notice shall be included in
+ * all copies or substantial portions of the Software.
+ *
+ * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
+ * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
+ * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE
+ * AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
+ * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING
+ * FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS
+ * IN THE SOFTWARE.
+ */
+
#include <string.h>
#include <stdio.h>
#include <stdint.h>
#include <unistd.h>
#include <stdlib.h>
+#include <math.h>
#include <libusb-1.0/libusb.h>
#define USB_TIMEOUT 10000
#define ID_VENDOR 0x18ef
#define ID_PRODUCT 0xe015
+#define EXT_TO_SEC(ext) ((1 << ((ext & 0xf0) >> 4)) * (ext & 0x0f) * 0.25)
+
extern char *optarg;
/* Not in all libusb-1.0 versions, so we have to roll our own :-( */
int i;
int ret;
- err = libusb_interrupt_transfer(devh, 0x01, send_data, 11, &cnt, 5000);
+ err = libusb_interrupt_transfer(devh, 0x01, send_data, 11, &cnt, USB_TIMEOUT);
if (err) {
fprintf(stderr, "Can't send data: %s\n", usb_strerror(err));
return 0;
}
- err = libusb_interrupt_transfer(devh, 0x81, recv_data, sizeof(recv_data), &cnt, 5000);
+ err = libusb_interrupt_transfer(devh, 0x81, recv_data, sizeof(recv_data), &cnt, USB_TIMEOUT);
if (err) {
fprintf(stderr, "Can't receive data: %s\n", usb_strerror(err));
return 0;
return command;
}
+int parse_extension(char *ext)
+{
+ int extension = -1;
+ char *ep;
+
+ if (ext == NULL)
+ return -1;
+
+ if ((ext[strlen(ext)-1] == 's') ||
+ (ext[strlen(ext)-1] == 'S')) {
+ double t;
+ double diff = 1;
+ uint8_t high = 0;
+ uint8_t low = 0;
+ uint8_t i;
+
+ t = strtod(ext, &ep);
+ if ((*ep != 's') && (*ep != 'S')) {
+ fprintf(stderr, "Not a valid time in seconds: %s\n", ext);
+ return -1;
+ }
+
+ /* time = 2^(high nibble) * (low nibble) * 0.25 , high may only be 12 */
+ t /= 0.25;
+#ifdef DEBUG
+ printf("t: %f\n", t);
+#endif
+
+ for(i = 1; i <= 0xf; i++) {
+ double h;
+ double l;
+ uint8_t i_l;
+ double d;
+
+#ifdef DEBUG
+ printf("i: 0x%01x\n", i);
+#endif
+
+ h = t / i;
+#ifdef DEBUG
+ printf("h: %f\n", h);
+#endif
+
+ l = log2(h);
+#ifdef DEBUG
+ printf("l: %f\n", l);
+#endif
+
+ i_l = l;
+ if (i_l > 12)
+ i_l = 12;
+
+ d = fabs(l - i_l);
+
+#ifdef DEBUG
+ printf("d: %f\n", d);
+#endif
+
+ if (d < diff) {
+#ifdef DEBUG
+ printf("Current best match!\n");
+#endif
+ diff = d;
+ high = i_l;
+ low = i;
+ }
+ }
+
+#ifdef DEBUG
+ printf("Got: %f, high: %01x, low: %01x\n", t, high, low);
+#endif
+
+ if ((high == 0) && (low == 0)) {
+ fprintf(stderr, "Can't find extension byte for %s!\n", ext);
+ return -1;
+ }
+
+ extension = ((high & 0xf) << 4) | (low & 0xf);
+ } else {
+ unsigned long val;
+
+ val = strtoul(ext, &ep, 16);
+ if (*ep != '\0') {
+ fprintf(stderr, "Not a 1 byte hexstring or time: %s\n", ext);
+ return -1;
+ }
+
+ extension = val & 0xff;
+ }
+
+ return extension;
+}
+
void syntax(char *prog)
{
fprintf(stderr, "Syntax: %s options\n\n", prog);
fprintf(stderr, "The following options need an housecode:\n");
fprintf(stderr, "\t-a [ELV|hex]\tdestination address\n");
fprintf(stderr, "\t-s [hex|alias]\tsend command byte\n");
- fprintf(stderr, "\t-e hex\t\textension byte for command\n");
+ fprintf(stderr, "\t-e [hex|time]\textension byte for command or time in seconds (e.g. 10s)\n");
fprintf(stderr, "\t-r n\t\trepeat sending n times\n");
fprintf(stderr, "\nCommand bytes (without extension byte):\n");
fprintf(stderr, "hex\t\talias\tdescription\n");
int opt;
int action = NO_ACTION;
int command = -1;
- uint8_t extension = 0x00;
+ int extension = 0;
uint8_t repeat = 0;
int addr = -1;
#endif
break;
case 'e':
- extension = strtoul(optarg, &ep, 16);
- if (*ep != '\0') {
+ extension = parse_extension(optarg);
+ if (extension == -1) {
fprintf(stderr, "Can't parse extension!\n");
exit(EXIT_FAILURE);
}
send_data[1] = 0x07;
send_data[2] = 0xf2;
send_data[8] = repeat;
- printf("Sending 0x%02x 0x%02x to address %d (hc: 0x%02x%02x) (repeated %d times)\n",
- command, extension, addr,
+ printf("Sending 0x%02x 0x%02x (%.2fs) to address %d (hc: 0x%02x%02x) (repeated %d times)\n",
+ command, extension, EXT_TO_SEC(extension), addr,
housecode[0], housecode[1],
repeat);
} else {
send_data[1] = 0x06;
send_data[2] = 0xf1;
- printf("Sending 0x%02x 0x%02x to address %d (hc: 0x%02x%02x)\n",
- command, extension, addr,
+ printf("Sending 0x%02x 0x%02x (%.2fs) to address %d (hc: 0x%02x%02x)\n",
+ command, extension, EXT_TO_SEC(extension), addr,
housecode[0], housecode[1]);
}
send_data[3] = housecode[0];
projects / fs20pcs / blobdiff