X-Git-Url: https://git.ao2.it/visomat-utils.git/blobdiff_plain/6d26d073abb2eed23a21d87058b8d6eb0e8d2112..e1d3986c78a172b4120056f03d4e2140bba0315b:/src/visomat-data-downloader.c diff --git a/src/visomat-data-downloader.c b/src/visomat-data-downloader.c index c2b8590..b471dc9 100644 --- a/src/visomat-data-downloader.c +++ b/src/visomat-data-downloader.c @@ -20,18 +20,45 @@ */ #include +#include #include #include #include #include #include +#ifdef DEBUG +#define debug(...) fprintf(stderr, __VA_ARGS__) +static void debug_dump_buffer(const char *filename, uint8_t *buffer, unsigned int len) +{ + FILE *dump_file; + + dump_file = fopen(filename, "wb"); + if (dump_file == NULL) { + fprintf(stderr, "Failed to open %s: %s\n", filename, strerror(errno)); + return; + } + + fwrite(buffer, 1, len, dump_file); + fclose(dump_file); +} +#else +#define debug(...) do {} while(0) +static void debug_dump_buffer(const char *filename, uint8_t *buffer, unsigned int len) +{ + (void)filename; + (void)buffer; + (void)len; +} +#endif + #define VISOMAT_DEVICE_VID 0x1247 #define VISOMAT_DEVICE_PID 0x00f8 #define VISOMAT_CONFIGURATION 1 #define VISOMAT_INTERFACE 1 #define VISOMAT_EP_IN 0x82 #define VISOMAT_EP_OUT 0x03 +#define VISOMAT_PACKET_SIZE 64 #define STX 0x02 #define ETX 0x03 @@ -71,7 +98,7 @@ struct pressure { unsigned int pulses; }; -static inline int extract_datetime(unsigned char *buffer, struct datetime *d) +static inline int extract_datetime(uint8_t *buffer, struct datetime *d) { int ret; @@ -120,7 +147,7 @@ static void print_record_csv_compat(struct datetime *d, struct pressure *p) } /* TODO: it would be better to separate decoding data from printing it */ -static int decode_eeprom(unsigned char *buffer, +static int decode_eeprom(uint8_t *buffer, unsigned int len, unsigned int user_mask) { @@ -133,8 +160,15 @@ static int decode_eeprom(unsigned char *buffer, struct datetime d; struct pressure p; - if (buffer[0] != STX || buffer[1] != 'M' || buffer[len - 1] != ETX) + if (buffer[0] != STX || buffer[1] != 'M') { + fprintf(stderr, "Usupported data.\n"); + return -EINVAL; + } + + if (buffer[len - 1] != ETX) { + fprintf(stderr, "Bad terminator in data. Buffer too small?\n"); return -EINVAL; + } /* skip the initial STX */ i = 1; @@ -156,6 +190,13 @@ static int decode_eeprom(unsigned char *buffer, /* user_id and num_records take 3 bytes */ i += 3; + /* + * when there are no records, there is a dummy byte + * which has to be consumed + */ + if (num_records == 0) + i += 1; + for (j = 0; j < num_records; j++) { ret = extract_datetime(buffer + i, &d); if (ret < 0) @@ -189,12 +230,12 @@ static int decode_eeprom(unsigned char *buffer, return 0; } -static int decode_datetime(unsigned char *buffer, unsigned int len) +static int decode_datetime(uint8_t *buffer, unsigned int len) { int ret; - unsigned char code[4] = { 0 }; + uint8_t code[4] = { 0 }; struct datetime d; - unsigned char *pbuffer = buffer; + uint8_t *pbuffer = buffer; if (len != 15) return -EINVAL; @@ -217,7 +258,7 @@ static int send_command(libusb_device_handle *dev, visomat_command cmd) { int ret; int transferred; - unsigned char request[5]; + uint8_t request[5]; request[0] = STX; request[1] = command_codes[cmd][0]; @@ -236,12 +277,12 @@ static int send_command(libusb_device_handle *dev, visomat_command cmd) } static int get_response(libusb_device_handle *dev, - unsigned char *buffer, + uint8_t *buffer, unsigned int len) { int ret; int transferred; - unsigned char response[64] = { 0 }; + uint8_t response[VISOMAT_PACKET_SIZE] = { 0 }; unsigned int i; i = 0; @@ -274,8 +315,8 @@ static int get_response(libusb_device_handle *dev, #define visomat_device libusb_device_handle static int visomat_dump_eeprom(visomat_device *dev, unsigned int user_mask) { - /* Assuming an EEPROM of 1 KiB */ - unsigned char buffer[1024] = { 0 }; + /* Assuming an EEPROM of 4 KiB */ + uint8_t buffer[4096] = { 0 }; int ret; ret = send_command(dev, VISOMAT_CMD_DUMP_EEPROM); @@ -283,6 +324,8 @@ static int visomat_dump_eeprom(visomat_device *dev, unsigned int user_mask) return ret; ret = get_response(dev, buffer, sizeof(buffer)); + debug("buffer size: %d\n", ret); + debug_dump_buffer("eeprom.bin", buffer, sizeof(buffer)); if (ret < 0) return ret; @@ -295,7 +338,7 @@ static int visomat_dump_eeprom(visomat_device *dev, unsigned int user_mask) static int visomat_get_datetime(visomat_device *dev) { - unsigned char buffer[255] = { 0 }; + uint8_t buffer[255] = { 0 }; int ret; ret = send_command(dev, VISOMAT_CMD_GET_DATETIME); @@ -313,12 +356,38 @@ static int visomat_get_datetime(visomat_device *dev) return 0; } -int main(void) +static void usage(const char *name) +{ + printf("usage: %s [OPTIONS]\n\n", name); + printf("OPTIONS:\n"); + printf("\t-D\t\tenable libusb debug output\n"); + printf("\t-h\t\tthis help message\n"); +} + +int main(int argc, char *argv[]) { int ret; + int opt; + bool enable_libusb_debug = false; libusb_device_handle *dev; int current_configuration; + while ((opt = getopt(argc, argv, "Dh")) != -1) { + switch (opt) { + case 'D': + enable_libusb_debug = true; + break; + case 'h': + usage(argv[0]); + ret = 0; + goto out; + default: /* '?' */ + usage(argv[0]); + ret = -EINVAL; + goto out; + } + } + ret = libusb_init(NULL); if (ret < 0) { fprintf(stderr, "libusb_init failed: %s\n", @@ -326,7 +395,8 @@ int main(void) goto out; } - libusb_set_debug(NULL, LIBUSB_LOG_LEVEL_INFO); + libusb_set_debug(NULL, enable_libusb_debug ? + LIBUSB_LOG_LEVEL_DEBUG : LIBUSB_LOG_LEVEL_INFO); dev = libusb_open_device_with_vid_pid(NULL, VISOMAT_DEVICE_VID, @@ -350,7 +420,7 @@ int main(void) if (ret < 0) { fprintf(stderr, "libusb_set_configuration failed: %s\n", libusb_error_name(ret)); - fprintf(stderr, "Cannot set configuration %hhu\n", + fprintf(stderr, "Cannot set configuration %d\n", VISOMAT_CONFIGURATION); goto out_libusb_close; } @@ -362,7 +432,7 @@ int main(void) if (ret < 0) { fprintf(stderr, "libusb_claim_interface failed: %s\n", libusb_error_name(ret)); - fprintf(stderr, "Cannot claim interface %hhu\n", + fprintf(stderr, "Cannot claim interface %d\n", VISOMAT_INTERFACE); goto out_libusb_close; } @@ -379,7 +449,7 @@ int main(void) } if (current_configuration != VISOMAT_CONFIGURATION) { - fprintf(stderr, "libusb configuration changed (expected: %hhu, current: %hhu\n", + fprintf(stderr, "libusb configuration changed (expected: %d, current: %d)\n", VISOMAT_CONFIGURATION, current_configuration); ret = -EINVAL; goto out_libusb_release_interface;