]> cvs.zerfleddert.de Git - hmcfgusb/blame - hmcfgusb.c
add possibility to log network communication
[hmcfgusb] / hmcfgusb.c
CommitLineData
9db2e455
MG
1/* HM-CFG-USB libusb-driver
2 *
3 * Copyright (c) 2013 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 <string.h>
25#include <stdio.h>
26#include <stdint.h>
27#include <unistd.h>
28#include <stdlib.h>
29#include <math.h>
30#include <poll.h>
31#include <errno.h>
f8718b41 32#include <sys/time.h>
9db2e455
MG
33#include <libusb-1.0/libusb.h>
34
37c97e62
MG
35/* Workaround for old libusb-1.0 */
36#ifndef LIBUSB_CALL
37#define LIBUSB_CALL
38#define libusb_handle_events_timeout_completed(ctx, tv, x) libusb_handle_events_timeout(ctx, tv)
39#endif
40
9db2e455
MG
41#include "hexdump.h"
42#include "hmcfgusb.h"
43
813afd12 44#define USB_TIMEOUT 10000
9db2e455
MG
45
46#define ID_VENDOR 0x1b1f
47#define ID_PRODUCT 0xc00f
4d0be794 48#define ID_PRODUCT_BL 0xc010
9db2e455
MG
49
50/* TODO: dynamic */
51#define ASYNC_SIZE 0x0040
52#define ASYNC_INTERVAL 32
53
54#define EP_OUT 0x02
55#define EP_IN 0x83
56
813afd12
MG
57#define INTERFACE 0
58
9db2e455 59static int quit = 0;
e75295bb 60static int debug = 0;
9db2e455
MG
61
62/* Not in all libusb-1.0 versions, so we have to roll our own :-( */
63static char * usb_strerror(int e)
64{
65 static char unknerr[256];
66
67 switch (e) {
68 case LIBUSB_SUCCESS:
69 return "Success";
70 case LIBUSB_ERROR_IO:
71 return "Input/output error";
72 case LIBUSB_ERROR_INVALID_PARAM:
73 return "Invalid parameter";
74 case LIBUSB_ERROR_ACCESS:
75 return "Access denied (insufficient permissions)";
76 case LIBUSB_ERROR_NO_DEVICE:
77 return "No such device (it may have been disconnected)";
78 case LIBUSB_ERROR_NOT_FOUND:
79 return "Entity not found";
80 case LIBUSB_ERROR_BUSY:
81 return "Resource busy";
82 case LIBUSB_ERROR_TIMEOUT:
83 return "Operation timed out";
84 case LIBUSB_ERROR_OVERFLOW:
85 return "Overflow";
86 case LIBUSB_ERROR_PIPE:
87 return "Pipe error";
88 case LIBUSB_ERROR_INTERRUPTED:
89 return "System call interrupted (perhaps due to signal)";
90 case LIBUSB_ERROR_NO_MEM:
91 return "Insufficient memory";
92 case LIBUSB_ERROR_NOT_SUPPORTED:
93 return "Operation not supported or unimplemented on this platform";
94 case LIBUSB_ERROR_OTHER:
95 return "Other error";
96 };
97 snprintf(unknerr, sizeof(unknerr), "Unknown error code %d / 0x%02x", e, e);
98 return unknerr;
99}
100
62f25bae 101static libusb_device_handle *hmcfgusb_find(int vid, int pid) {
9db2e455
MG
102 libusb_device_handle *devh = NULL;
103 libusb_device **list;
104 ssize_t cnt;
105 ssize_t i;
106 int err;
107
108 cnt = libusb_get_device_list(NULL, &list);
109 if (cnt < 0) {
110 fprintf(stderr, "Can't get USB device list: %d\n", (int)cnt);
111 return NULL;
112 }
113
114 for (i = 0; i < cnt; i++){
115 struct libusb_device_descriptor desc;
116
117 err = libusb_get_device_descriptor(list[i], &desc);
118 if (err)
119 continue;
120
62f25bae 121 if ((desc.idVendor == vid) && (desc.idProduct == pid)) {
9db2e455
MG
122 libusb_device *dev = list[i];
123
124 err = libusb_open(dev, &devh);
125 if (err) {
126 fprintf(stderr, "Can't open device: %s\n", usb_strerror(err));
127 return NULL;
128 }
129
813afd12 130 err = libusb_detach_kernel_driver(devh, INTERFACE);
9db2e455
MG
131 if ((err != 0) && (err != LIBUSB_ERROR_NOT_FOUND)) {
132 fprintf(stderr, "Can't detach kernel driver: %s\n", usb_strerror(err));
133 return NULL;
134 }
135
813afd12 136 err = libusb_claim_interface(devh, INTERFACE);
9db2e455
MG
137 if ((err != 0)) {
138 fprintf(stderr, "Can't claim interface: %s\n", usb_strerror(err));
139 return NULL;
140 }
141
142 return devh;
143 }
144
145 }
146
147 return NULL;
148}
149
6262005e 150int hmcfgusb_send_null_frame(struct hmcfgusb_dev *usbdev, int silent)
2a6eaefc
MG
151{
152 int err;
153 int cnt;
3435bdb6 154 unsigned char out[0x40];
2a6eaefc 155
3435bdb6
MG
156 memset(out, 0, sizeof(out));
157
3d5b8e70 158 err = libusb_interrupt_transfer(usbdev->usb_devh, EP_OUT, out, 0, &cnt, USB_TIMEOUT);
6262005e
MG
159 if (err && (!silent)) {
160 fprintf(stderr, "Can't send null frame: %s\n", usb_strerror(err));
2a6eaefc
MG
161 return 0;
162 }
163
164 return 1;
165}
166
9db2e455
MG
167int hmcfgusb_send(struct hmcfgusb_dev *usbdev, unsigned char* send_data, int len, int done)
168{
169 int err;
170 int cnt;
f8718b41
MG
171 struct timeval tv_start, tv_end;
172 int msec;
9db2e455 173
f8718b41 174 if (debug) {
627e3f33 175 hexdump(send_data, len, "USB < ");
f8718b41
MG
176 }
177
d200d8ca
MG
178 gettimeofday(&tv_start, NULL);
179
9db2e455
MG
180 err = libusb_interrupt_transfer(usbdev->usb_devh, EP_OUT, send_data, len, &cnt, USB_TIMEOUT);
181 if (err) {
182 fprintf(stderr, "Can't send data: %s\n", usb_strerror(err));
9db2e455
MG
183 return 0;
184 }
185
186 if (done) {
6262005e 187 if (!hmcfgusb_send_null_frame(usbdev, 0)) {
9db2e455
MG
188 return 0;
189 }
190 }
191
d200d8ca
MG
192 gettimeofday(&tv_end, NULL);
193 msec = ((tv_end.tv_sec-tv_start.tv_sec)*1000)+((tv_end.tv_usec-tv_start.tv_usec)/1000);
194
195 if (msec > 100) {
6df7655e 196 fprintf(stderr, "usb-transfer took more than 100ms (%dms), this may lead to timing problems!\n", msec);
d200d8ca
MG
197 } else if (debug) {
198 fprintf(stderr, "usb-transfer took %dms!\n", msec);
f8718b41
MG
199 }
200
e0a7146e 201 return 1;
9db2e455
MG
202}
203
b5e57d26 204static struct libusb_transfer *hmcfgusb_prepare_int(libusb_device_handle *devh, libusb_transfer_cb_fn cb, void *data, int in_size)
9db2e455
MG
205{
206 unsigned char *data_buf;
207 struct libusb_transfer *transfer;
208 int err;
209
b5e57d26 210 data_buf = malloc(in_size);
9db2e455
MG
211 if (!data_buf) {
212 fprintf(stderr, "Can't allocate memory for data-buffer!\n");
213 return NULL;
214 }
215
216 transfer = libusb_alloc_transfer(0);
217 if (!transfer) {
218 fprintf(stderr, "Can't allocate memory for usb-transfer!\n");
219 free(data_buf);
220 return NULL;
221 }
222
223 libusb_fill_interrupt_transfer(transfer, devh, EP_IN,
b5e57d26 224 data_buf, in_size, cb, data, USB_TIMEOUT);
9db2e455 225
bafd75c9 226 transfer->flags = LIBUSB_TRANSFER_FREE_BUFFER;
9db2e455
MG
227
228 err = libusb_submit_transfer(transfer);
229 if (err != 0) {
230 fprintf(stderr, "Can't submit transfer: %s\n", usb_strerror(err));
231 libusb_free_transfer(transfer);
9db2e455
MG
232 return NULL;
233 }
234
235 return transfer;
236}
237
238struct hmcfgusb_cb_data {
813afd12 239 struct hmcfgusb_dev *dev;
9db2e455
MG
240 hmcfgusb_cb_fn cb;
241 void *data;
242};
243
244static void LIBUSB_CALL hmcfgusb_interrupt(struct libusb_transfer *transfer)
245{
246 int err;
247 struct hmcfgusb_cb_data *cb_data;
248
813afd12
MG
249 cb_data = transfer->user_data;
250
9db2e455
MG
251 if (transfer->status != LIBUSB_TRANSFER_COMPLETED) {
252 if (transfer->status != LIBUSB_TRANSFER_TIMED_OUT) {
032d6050 253 fprintf(stderr, "Interrupt transfer not completed: %s!\n", usb_strerror(transfer->status));
9db2e455 254 quit = EIO;
813afd12
MG
255
256 if (cb_data && cb_data->dev && cb_data->dev->transfer) {
257 libusb_free_transfer(cb_data->dev->transfer);
258 cb_data->dev->transfer = NULL;
4cadd56d 259 free(cb_data);
813afd12 260 }
9db2e455
MG
261 return;
262 }
9db2e455 263 } else {
27bb301b 264 if (cb_data && cb_data->cb) {
e0a7146e 265 if (debug)
627e3f33 266 hexdump(transfer->buffer, transfer->actual_length, "USB > ");
4371275b
MG
267
268 if (!cb_data->cb(transfer->buffer, transfer->actual_length, cb_data->data)) {
269 quit = EIO;
270
271 if (cb_data && cb_data->dev && cb_data->dev->transfer) {
272 libusb_free_transfer(cb_data->dev->transfer);
273 cb_data->dev->transfer = NULL;
4cadd56d 274 free(cb_data);
4371275b
MG
275 }
276
277 return;
278 }
27bb301b 279 } else {
e0a7146e 280 hexdump(transfer->buffer, transfer->actual_length, "> ");
27bb301b 281 }
9db2e455
MG
282 }
283
284 err = libusb_submit_transfer(transfer);
285 if (err != 0) {
286 fprintf(stderr, "Can't re-submit transfer: %s\n", usb_strerror(err));
9db2e455 287 libusb_free_transfer(transfer);
4cadd56d
MG
288 cb_data->dev->transfer = NULL;
289 free(cb_data);
9db2e455
MG
290 }
291}
292
293struct hmcfgusb_dev *hmcfgusb_init(hmcfgusb_cb_fn cb, void *data)
294{
295 libusb_device_handle *devh = NULL;
296 const struct libusb_pollfd **usb_pfd = NULL;
297 struct hmcfgusb_dev *dev = NULL;
298 struct hmcfgusb_cb_data *cb_data = NULL;
62f25bae 299 int bootloader = 0;
9db2e455
MG
300 int err;
301 int i;
302
303 err = libusb_init(NULL);
304 if (err != 0) {
305 fprintf(stderr, "Can't initialize libusb: %s\n", usb_strerror(err));
306 return NULL;
307 }
308
62f25bae 309 devh = hmcfgusb_find(ID_VENDOR, ID_PRODUCT);
9db2e455 310 if (!devh) {
62f25bae
MG
311 devh = hmcfgusb_find(ID_VENDOR, ID_PRODUCT_BL);
312 if (!devh) {
313 fprintf(stderr, "Can't find/open hmcfgusb!\n");
211fd7e5 314 libusb_exit(NULL);
62f25bae
MG
315 return NULL;
316 }
317 bootloader = 1;
9db2e455
MG
318 }
319
320 dev = malloc(sizeof(struct hmcfgusb_dev));
321 if (!dev) {
322 perror("Can't allocate memory for hmcfgusb_dev");
211fd7e5
MG
323 libusb_close(devh);
324 libusb_exit(NULL);
9db2e455
MG
325 return NULL;
326 }
327
328 memset(dev, 0, sizeof(struct hmcfgusb_dev));
329 dev->usb_devh = devh;
62f25bae
MG
330 dev->bootloader = bootloader;
331 dev->opened_at = time(NULL);
9db2e455
MG
332
333 cb_data = malloc(sizeof(struct hmcfgusb_cb_data));
334 if (!cb_data) {
335 perror("Can't allocate memory for hmcfgusb_cb_data");
4cadd56d 336 free(dev);
211fd7e5
MG
337 libusb_close(devh);
338 libusb_exit(NULL);
9db2e455
MG
339 return NULL;
340 }
341
342 memset(cb_data, 0, sizeof(struct hmcfgusb_cb_data));
343
813afd12 344 cb_data->dev = dev;
9db2e455
MG
345 cb_data->cb = cb;
346 cb_data->data = data;
347
bafd75c9 348 dev->transfer = hmcfgusb_prepare_int(devh, hmcfgusb_interrupt, cb_data, ASYNC_SIZE);
b5e57d26 349
9db2e455
MG
350 if (!dev->transfer) {
351 fprintf(stderr, "Can't prepare async device io!\n");
4cadd56d
MG
352 free(dev);
353 free(cb_data);
211fd7e5
MG
354 libusb_close(devh);
355 libusb_exit(NULL);
9db2e455
MG
356 return NULL;
357 }
358
359 usb_pfd = libusb_get_pollfds(NULL);
360 if (!usb_pfd) {
361 fprintf(stderr, "Can't get FDset from libusb!\n");
362 free(dev);
4cadd56d 363 free(cb_data);
211fd7e5
MG
364 libusb_close(devh);
365 libusb_exit(NULL);
9db2e455
MG
366 return NULL;
367 }
368
369 dev->n_usb_pfd = 0;
370 for(i = 0; usb_pfd[i]; i++)
371 dev->n_usb_pfd++;
372
373 dev->pfd = malloc(dev->n_usb_pfd * sizeof(struct pollfd));
374 if (!dev->pfd) {
375 perror("Can't allocate memory for poll-fds");
4cadd56d
MG
376 free(dev);
377 free(cb_data);
211fd7e5
MG
378 libusb_close(devh);
379 libusb_exit(NULL);
9db2e455
MG
380 return NULL;
381 }
382
383 memset(dev->pfd, 0, dev->n_usb_pfd * sizeof(struct pollfd));
384
385 for (i = 0; i < dev->n_usb_pfd; i++) {
386 dev->pfd[i].fd = usb_pfd[i]->fd;
387 dev->pfd[i].events = usb_pfd[i]->events;
388 dev->pfd[i].revents = 0;
389 }
390
391 free(usb_pfd);
392
393 dev->n_pfd = dev->n_usb_pfd;
394
f16395da
MG
395 quit = 0;
396
9db2e455
MG
397 return dev;
398}
399
400int hmcfgusb_add_pfd(struct hmcfgusb_dev *dev, int fd, short events)
401{
402 dev->n_pfd++;
403 dev->pfd = realloc(dev->pfd, dev->n_pfd * sizeof(struct pollfd));
404 if (!dev->pfd) {
405 perror("Can't realloc poll-fds");
406 return 0;
407 }
408
409 dev->pfd[dev->n_pfd-1].fd = fd;
410 dev->pfd[dev->n_pfd-1].events = events;
411 dev->pfd[dev->n_pfd-1].revents = 0;
412
413 return 1;
414}
415
416int hmcfgusb_poll(struct hmcfgusb_dev *dev, int timeout)
417{
418 struct timeval tv;
419 int usb_event = 0;
1e79d00a 420 int timed_out = 0;
9db2e455
MG
421 int i;
422 int n;
423 int fd_n;
424 int err;
425
426 errno = 0;
427
428 memset(&tv, 0, sizeof(tv));
429 err = libusb_get_next_timeout(NULL, &tv);
430 if (err < 0) {
431 fprintf(stderr, "libusb_get_next_timeout: %s\n", usb_strerror(err));
432 errno = EIO;
433 return -1;
434 } else if (err == 0) {
435 /* No pending timeout or a sane platform */
9db2e455
MG
436 } else {
437 if ((tv.tv_sec == 0) && (tv.tv_usec == 0)) {
438 usb_event = 1;
3b35a8c1
MG
439 } else if ((tv.tv_sec * 1000) < timeout) {
440 timeout = tv.tv_sec * 1000;
9db2e455
MG
441 }
442 }
443
444 if (!usb_event) {
445 for (i = 0; i < dev->n_pfd; i++) {
446 dev->pfd[i].revents = 0;
447 }
448
3b35a8c1 449 n = poll(dev->pfd, dev->n_pfd, timeout);
9db2e455
MG
450 if (n < 0) {
451 perror("poll");
816f5cd2 452 errno = 0;
9db2e455
MG
453 return -1;
454 } else if (n == 0) {
455 usb_event = 1;
1e79d00a 456 timed_out = 1;
9db2e455
MG
457 } else {
458 for (fd_n = 0; fd_n < dev->n_pfd; fd_n++) {
459 if (dev->pfd[fd_n].revents) {
460 if (fd_n < dev->n_usb_pfd) {
461 usb_event = 1;
462 break;
463 } else {
816f5cd2 464 errno = 0;
9db2e455
MG
465 return dev->pfd[fd_n].fd;
466 }
467 }
468 }
469 }
470 }
471
472 if (usb_event) {
473 memset(&tv, 0, sizeof(tv));
474 err = libusb_handle_events_timeout_completed(NULL, &tv, NULL);
475 if (err < 0) {
27bb301b 476 fprintf(stderr, "libusb_handle_events_timeout_completed: %s\n", usb_strerror(err));
9db2e455
MG
477 errno = EIO;
478 return -1;
479 }
480 }
481
816f5cd2
MG
482 errno = 0;
483 if (quit) {
484 fprintf(stderr, "closing device-connection due to error %d\n", quit);
9db2e455 485 errno = quit;
816f5cd2 486 }
9db2e455 487
1e79d00a
MG
488 if (timed_out)
489 errno = ETIMEDOUT;
490
9db2e455
MG
491 return -1;
492}
813afd12 493
62f25bae
MG
494void hmcfgusb_enter_bootloader(struct hmcfgusb_dev *dev)
495{
496 uint8_t out[ASYNC_SIZE];
497
498 if (dev->bootloader) {
499 fprintf(stderr, "request for bootloader mode, but device already in bootloader!\n");
500 return;
501 }
502
503 memset(out, 0, sizeof(out));
504 out[0] = 'B';
505 hmcfgusb_send(dev, out, sizeof(out), 1);
506
507 return;
508}
509
0ddb3740
MG
510void hmcfgusb_leave_bootloader(struct hmcfgusb_dev *dev)
511{
512 uint8_t out[ASYNC_SIZE];
513
514 if (!dev->bootloader) {
515 fprintf(stderr, "request for leaving bootloader mode, but device already in normal mode!\n");
516 return;
517 }
518
519 memset(out, 0, sizeof(out));
520 out[0] = 'K';
521 hmcfgusb_send(dev, out, sizeof(out), 1);
522
523 return;
524}
525
813afd12
MG
526void hmcfgusb_close(struct hmcfgusb_dev *dev)
527{
528 int err;
529
530 if (dev->transfer) {
531 libusb_cancel_transfer(dev->transfer);
532 }
533
534 err = libusb_release_interface(dev->usb_devh, INTERFACE);
535 if ((err != 0)) {
536 fprintf(stderr, "Can't release interface: %s\n", usb_strerror(err));
537 }
538
539 libusb_close(dev->usb_devh);
e0a7146e 540 free(dev->pfd);
813afd12
MG
541 free(dev);
542
543 libusb_exit(NULL);
544}
e75295bb
MG
545
546void hmcfgusb_set_debug(int d)
547{
548 debug = d;
549}
Impressum, Datenschutz