+
+ fw_blocks++;
+ if (debug)
+ printf("Firmware block %d with length %u read.\n", fw_blocks, len);
+ } while(r > 0);
+
+ if (fw_blocks == 0) {
+ fprintf(stderr, "Firmware file not valid!\n");
+ exit(EXIT_FAILURE);
+ }
+
+ printf("Firmware with %d blocks successfully read.\n", fw_blocks);
+
+ hmcfgusb_set_debug(debug);
+
+ memset(&rdata, 0, sizeof(rdata));
+
+ dev = hmcfgusb_init(parse_hmcfgusb, &rdata);
+ if (!dev) {
+ fprintf(stderr, "Can't initialize HM-CFG-USB\n");
+ exit(EXIT_FAILURE);
+ }
+
+ if (!dev->bootloader) {
+ fprintf(stderr, "\nHM-CFG-USB not in bootloader mode, entering bootloader.\n");
+ hmcfgusb_enter_bootloader(dev);
+ fprintf(stderr, "\nWaiting for device to reappear...\n");
+
+ do {
+ sleep(1);
+ } while ((dev = hmcfgusb_init(parse_hmcfgusb, &rdata)) == NULL);
+
+ if (!dev->bootloader) {
+ fprintf(stderr, "Can't enter bootloader, giving up!\n");
+ exit(EXIT_FAILURE);
+ }
+ }
+
+ printf("\nHM-CFG-USB opened.\n\n");
+
+
+ printf("Flashing %d blocks", fw_blocks);
+ if (debug) {
+ printf("\n");
+ } else {
+ printf(": %c", twiddlie[0]);
+ fflush(stdout);
+ }
+
+ for (block = 0; block < fw_blocks; block++) {
+ len = fw[block][2] << 8;
+ len |= fw[block][3];
+
+ len += 4; /* block nr., length */
+
+ if (debug)
+ hexdump(fw[block], len, "F> ");
+
+ rdata.ack = 0;
+ if (!hmcfgusb_send(dev, fw[block], len, 0)) {
+ perror("\n\nhmcfgusb_send");
+ exit(EXIT_FAILURE);
+ }
+
+ if (debug)
+ printf("Waiting for ack...\n");
+ do {
+ errno = 0;
+ pfd = hmcfgusb_poll(dev, 1);
+ if ((pfd < 0) && errno) {
+ perror("\n\nhmcfgusb_poll");
+ exit(EXIT_FAILURE);
+ }
+ if (rdata.ack) {
+ break;
+ }
+ } while (pfd < 0);
+
+ if (rdata.ack == 2) {
+ printf("\n\nFirmware update successfull!\n");
+ break;
+ }
+
+ if (rdata.ack != 1) {
+ fprintf(stderr, "\n\nError flashing block %d, status: %u\n", block, rdata.ack);
+ exit(EXIT_FAILURE);
+ }
+
+ if (!debug) {
+ printf("\b%c", twiddlie[block % sizeof(twiddlie)]);
+ fflush(stdout);
+ }
+ free(fw[block]);
+ }
+
+ free(fw);