more minor cleanups
[hmcfgusb] / flash-hmcfgusb.c
1 /* flasher for HM-CFG-USB
2 *
3 * Copyright (c) 2013-14 Michael Gernoth <michael@gernoth.net>
4 *
5 * Permission is hereby granted, free of charge, to any person obtaining a copy
6 * of this software and associated documentation files (the "Software"), to
7 * deal in the Software without restriction, including without limitation the
8 * rights to use, copy, modify, merge, publish, distribute, sublicense, and/or
9 * sell copies of the Software, and to permit persons to whom the Software is
10 * furnished to do so, subject to the following conditions:
11 *
12 * The above copyright notice and this permission notice shall be included in
13 * all copies or substantial portions of the Software.
14 *
15 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
16 * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
17 * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE
18 * AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
19 * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING
20 * FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS
21 * IN THE SOFTWARE.
22 */
23
24 #include <stdio.h>
25 #include <stdlib.h>
26 #include <unistd.h>
27 #include <stdint.h>
28 #include <string.h>
29 #include <strings.h>
30 #include <poll.h>
31 #include <errno.h>
32 #include <sys/types.h>
33 #include <sys/stat.h>
34 #include <fcntl.h>
35 #include <sys/time.h>
36 #include <libusb-1.0/libusb.h>
37
38 #include "hexdump.h"
39 #include "firmware.h"
40 #include "version.h"
41 #include "hmcfgusb.h"
42
43 struct recv_data {
44 int ack;
45 };
46
47 static int parse_hmcfgusb(uint8_t *buf, int buf_len, void *data)
48 {
49 struct recv_data *rdata = data;
50
51 if (buf_len != 1)
52 return 1;
53
54 rdata->ack = buf[0];
55
56 return 1;
57 }
58
59 int main(int argc, char **argv)
60 {
61 const char twiddlie[] = { '-', '\\', '|', '/' };
62 struct hmcfgusb_dev *dev;
63 struct recv_data rdata;
64 uint16_t len;
65 struct firmware *fw;
66 int block;
67 int pfd;
68 int debug = 0;
69
70 printf("HM-CFG-USB flasher version " VERSION "\n\n");
71
72 if (argc != 2) {
73 if (argc == 1)
74 fprintf(stderr, "Missing firmware filename!\n\n");
75
76 fprintf(stderr, "Syntax: %s hmusbif.enc\n\n", argv[0]);
77 exit(EXIT_FAILURE);
78 }
79
80 fw = firmware_read_firmware(argv[1], debug);
81 if (!fw)
82 exit(EXIT_FAILURE);
83
84 hmcfgusb_set_debug(debug);
85
86 memset(&rdata, 0, sizeof(rdata));
87
88 dev = hmcfgusb_init(parse_hmcfgusb, &rdata);
89 if (!dev) {
90 fprintf(stderr, "Can't initialize HM-CFG-USB\n");
91 exit(EXIT_FAILURE);
92 }
93
94 if (!dev->bootloader) {
95 fprintf(stderr, "\nHM-CFG-USB not in bootloader mode, entering bootloader.\n");
96 hmcfgusb_enter_bootloader(dev);
97 fprintf(stderr, "\nWaiting for device to reappear...\n");
98
99 do {
100 sleep(2);
101 } while ((dev = hmcfgusb_init(parse_hmcfgusb, &rdata)) == NULL);
102
103 if (!dev->bootloader) {
104 fprintf(stderr, "Can't enter bootloader, giving up!\n");
105 exit(EXIT_FAILURE);
106 }
107 }
108
109 printf("\nHM-CFG-USB opened.\n\n");
110
111
112 printf("Flashing %d blocks", fw->fw_blocks);
113 if (debug) {
114 printf("\n");
115 } else {
116 printf(": %c", twiddlie[0]);
117 fflush(stdout);
118 }
119
120 for (block = 0; block < fw->fw_blocks; block++) {
121 len = fw->fw[block][2] << 8;
122 len |= fw->fw[block][3];
123
124 len += 4; /* block nr., length */
125
126 if (debug)
127 hexdump(fw->fw[block], len, "F> ");
128
129 rdata.ack = 0;
130 if (!hmcfgusb_send(dev, fw->fw[block], len, 0)) {
131 perror("\n\nhmcfgusb_send");
132 exit(EXIT_FAILURE);
133 }
134
135 if (debug)
136 printf("Waiting for ack...\n");
137 do {
138 errno = 0;
139 pfd = hmcfgusb_poll(dev, 1);
140 if ((pfd < 0) && errno) {
141 if (errno != ETIMEDOUT) {
142 perror("\n\nhmcfgusb_poll");
143 exit(EXIT_FAILURE);
144 }
145 }
146 if (rdata.ack) {
147 break;
148 }
149 } while (pfd < 0);
150
151 if (rdata.ack == 2) {
152 printf("\n\nFirmware update successfull!\n");
153 break;
154 }
155
156 if (rdata.ack != 1) {
157 fprintf(stderr, "\n\nError flashing block %d, status: %u\n", block, rdata.ack);
158 exit(EXIT_FAILURE);
159 }
160
161 if (!debug) {
162 printf("\b%c", twiddlie[block % sizeof(twiddlie)]);
163 fflush(stdout);
164 }
165 }
166
167 firmware_free(fw);
168
169 hmcfgusb_close(dev);
170
171 return EXIT_SUCCESS;
172 }
Impressum, Datenschutz