]>
Commit | Line | Data |
---|---|---|
4417074c GS |
1 | /* |
2 | * This file is part of the libsigrok project. | |
3 | * | |
4 | * Copyright (C) 2017-2019 Gerhard Sittig <gerhard.sittig@gmx.net> | |
5 | * | |
6 | * This program is free software: you can redistribute it and/or modify | |
7 | * it under the terms of the GNU General Public License as published by | |
8 | * the Free Software Foundation, either version 3 of the License, or | |
9 | * (at your option) any later version. | |
10 | * | |
11 | * This program is distributed in the hope that it will be useful, | |
12 | * but WITHOUT ANY WARRANTY; without even the implied warranty of | |
13 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the | |
14 | * GNU General Public License for more details. | |
15 | * | |
16 | * You should have received a copy of the GNU General Public License | |
17 | * along with this program. If not, see <http://www.gnu.org/licenses/>. | |
18 | */ | |
19 | ||
20 | #include "config.h" | |
edec0436 GS |
21 | #include <glib.h> |
22 | #ifdef HAVE_LIBHIDAPI | |
23 | #include <hidapi.h> | |
24 | #endif | |
4417074c GS |
25 | #include <libsigrok/libsigrok.h> |
26 | #include "libsigrok-internal.h" | |
edec0436 GS |
27 | #include "serial_hid.h" |
28 | #include <stdlib.h> | |
29 | #include <string.h> | |
30 | #ifdef G_OS_WIN32 | |
31 | #include <windows.h> /* for HANDLE */ | |
32 | #endif | |
4417074c GS |
33 | |
34 | /** @cond PRIVATE */ | |
35 | #define LOG_PREFIX "serial-hid" | |
36 | /** @endcond */ | |
37 | ||
edec0436 GS |
38 | #ifdef HAVE_SERIAL_COMM |
39 | ||
40 | /** | |
41 | * @file | |
42 | * | |
43 | * Serial port handling, HIDAPI library specific support code. | |
44 | */ | |
45 | ||
46 | /** | |
47 | * @defgroup grp_serial_hid Serial port handling, HID group | |
48 | * | |
49 | * Make serial-over-HID communication appear like a regular serial port. | |
50 | * | |
51 | * @{ | |
52 | */ | |
53 | ||
54 | #ifdef HAVE_LIBHIDAPI | |
55 | /* {{{ helper routines */ | |
56 | ||
57 | /* Strip off parity bits for "odd" data bit counts like in 7e1 frames. */ | |
58 | static void ser_hid_mask_databits(struct sr_serial_dev_inst *serial, | |
59 | uint8_t *data, size_t len) | |
60 | { | |
61 | uint32_t mask32; | |
62 | uint8_t mask; | |
63 | size_t idx; | |
64 | ||
65 | if ((serial->comm_params.data_bits % 8) == 0) | |
66 | return; | |
67 | ||
68 | mask32 = (1UL << serial->comm_params.data_bits) - 1; | |
69 | mask = mask32 & 0xff; | |
70 | for (idx = 0; idx < len; idx++) | |
71 | data[idx] &= mask; | |
72 | } | |
73 | ||
74 | /* }}} */ | |
75 | /* {{{ open/close/list/find HIDAPI connection, exchange HID requests and data */ | |
76 | ||
77 | /* | |
78 | * Convert a HIDAPI path (which depends on the target platform, and may | |
79 | * depend on one of several available API variants on that platform) to | |
80 | * something that is usable as a "port name" in conn= specs. | |
81 | * | |
82 | * Since conn= is passed with -d where multiple options (among them conn=) | |
83 | * are separated by colons, port names themselves cannot contain colons. | |
84 | * | |
85 | * Just replace colons by a period in the simple case (Linux platform, | |
86 | * hidapi-libusb implementation, bus/address/interface). Prefix the | |
87 | * HIDAPI path in the complex cases (Linux hidapi-hidraw, Windows, Mac). | |
88 | * Paths with colons outside of libusb based implementations are unhandled | |
89 | * here, but were not yet seen on any sigrok supported platform either. | |
90 | * So just reject them. | |
91 | */ | |
92 | static char *get_hidapi_path_copy(const char *path) | |
93 | { | |
94 | static const char *accept = "0123456789abcdefABCDEF:"; | |
95 | static const char *keep = "0123456789abcdefABCDEF"; | |
96 | ||
97 | int has_colon; | |
98 | int is_hex_colon; | |
99 | char *name; | |
100 | ||
101 | has_colon = strchr(path, ':') != NULL; | |
102 | is_hex_colon = strspn(path, accept) == strlen(path); | |
103 | if (has_colon && !is_hex_colon) { | |
104 | sr_err("Unsupported HIDAPI path format: %s", path); | |
105 | return NULL; | |
106 | } | |
107 | if (is_hex_colon) { | |
108 | name = g_strdup_printf("%s%s", SER_HID_USB_PREFIX, path); | |
109 | g_strcanon(name + strlen(SER_HID_USB_PREFIX), keep, '.'); | |
110 | } else { | |
111 | name = g_strdup_printf("%s%s", SER_HID_RAW_PREFIX, path); | |
112 | } | |
113 | ||
114 | return name; | |
115 | } | |
116 | ||
117 | /* | |
118 | * Undo the port name construction that was done during scan. Extract | |
119 | * the HIDAPI path from a conn= input spec (the part after the hid/ | |
120 | * prefix and chip type). | |
121 | * | |
122 | * Strip off the "raw" prefix, or undo colon substitution. See @ref | |
123 | * get_hidapi_path_copy() for details. | |
124 | */ | |
125 | static const char *extract_hidapi_path(char *buffer) | |
126 | { | |
127 | static const char *keep = "0123456789abcdefABCDEF:"; | |
128 | ||
129 | const char *p; | |
130 | ||
131 | p = buffer; | |
132 | if (!p || !*p) | |
133 | return NULL; | |
134 | ||
135 | if (strncmp(p, SER_HID_RAW_PREFIX, strlen(SER_HID_RAW_PREFIX)) == 0) { | |
136 | p += strlen(SER_HID_RAW_PREFIX); | |
137 | return p; | |
138 | } | |
139 | if (strncmp(p, SER_HID_USB_PREFIX, strlen(SER_HID_USB_PREFIX)) == 0) { | |
140 | p += strlen(SER_HID_USB_PREFIX); | |
141 | g_strcanon(buffer, keep, ':'); | |
142 | return p; | |
143 | } | |
144 | ||
145 | return NULL; | |
146 | } | |
147 | ||
148 | /* | |
149 | * The HIDAPI specific list() callback, invoked by common serial.c code. | |
150 | * Enumerate all devices (no VID:PID is involved). | |
151 | * Invoke an 'append' callback with "path" and "name". | |
152 | */ | |
153 | static GSList *ser_hid_hidapi_list(GSList *list, sr_ser_list_append_t append) | |
154 | { | |
155 | struct hid_device_info *devs, *curdev; | |
156 | const char *chipname; | |
157 | char *path, *name; | |
158 | wchar_t *manuf, *prod, *serno; | |
159 | uint16_t vid, pid; | |
160 | GString *desc; | |
161 | ||
162 | devs = hid_enumerate(0x0000, 0x0000); | |
163 | for (curdev = devs; curdev; curdev = curdev->next) { | |
164 | /* | |
165 | * Determine the chip name from VID:PID (if it's one of | |
166 | * the supported types with an ID known to us). | |
167 | */ | |
168 | vid = curdev->vendor_id; | |
169 | pid = curdev->product_id; | |
170 | sr_dbg("DIAG: hidapi enum, vid:pid %04x:%04x, path %s\n", | |
171 | curdev->vendor_id, curdev->product_id, curdev->path); | |
172 | chipname = ser_hid_chip_find_name_vid_pid(vid, pid); | |
173 | if (!chipname) | |
174 | chipname = "<chip>"; | |
175 | ||
176 | /* | |
177 | * Prefix port names such that open() calls with this | |
178 | * conn= spec will end up here and contain all details | |
179 | * that are essential for processing. | |
180 | */ | |
181 | path = get_hidapi_path_copy(curdev->path); | |
182 | if (!path) | |
183 | continue; | |
184 | name = g_strdup_printf("%s/%s/%s", | |
185 | SER_HID_CONN_PREFIX, chipname, path); | |
186 | g_free(path); | |
187 | ||
188 | /* | |
189 | * Print whatever information was available. Construct | |
190 | * the description text from pieces. Absence of fields | |
191 | * is not fatal, we have seen perfectly usable cables | |
192 | * that only had a VID and PID (permissions were not an | |
193 | * issue). | |
194 | */ | |
195 | manuf = curdev->manufacturer_string; | |
196 | prod = curdev->product_string; | |
197 | serno = curdev->serial_number; | |
198 | vid = curdev->vendor_id; | |
199 | pid = curdev->product_id; | |
200 | desc = g_string_sized_new(128); | |
201 | g_string_append_printf(desc, "HID"); | |
be7c63dc | 202 | if (manuf && wcslen(manuf) != 0) |
edec0436 | 203 | g_string_append_printf(desc, " %ls", manuf); |
be7c63dc | 204 | if (prod && wcslen(prod) != 0) |
edec0436 | 205 | g_string_append_printf(desc, " %ls", prod); |
be7c63dc | 206 | if (serno && wcslen(serno) != 0) |
edec0436 GS |
207 | g_string_append_printf(desc, " %ls", serno); |
208 | if (vid && pid) | |
be7c63dc | 209 | g_string_append_printf(desc, " [%04hx.%04hx]", vid, pid); |
edec0436 GS |
210 | list = append(list, name, desc->str); |
211 | g_string_free(desc, TRUE); | |
212 | g_free(name); | |
213 | } | |
214 | hid_free_enumeration(devs); | |
215 | ||
216 | return list; | |
217 | } | |
218 | ||
219 | /* | |
220 | * The HIDAPI specific find_usb() callback, invoked by common serial.c code. | |
221 | * Enumerate devices for the specified VID:PID pair. | |
222 | * Invoke an "append" callback with 'path' for the device. | |
223 | */ | |
224 | static GSList *ser_hid_hidapi_find_usb(GSList *list, sr_ser_find_append_t append, | |
225 | uint16_t vendor_id, uint16_t product_id) | |
226 | { | |
227 | struct hid_device_info *devs, *curdev; | |
228 | const char *name; | |
229 | ||
230 | devs = hid_enumerate(vendor_id, product_id); | |
231 | for (curdev = devs; curdev; curdev = curdev->next) { | |
232 | name = curdev->path; | |
233 | list = append(list, name); | |
234 | } | |
235 | hid_free_enumeration(devs); | |
236 | ||
237 | return list; | |
238 | } | |
239 | ||
240 | /* Get the serial number of a device specified by path. */ | |
241 | static int ser_hid_hidapi_get_serno(const char *path, char *buf, size_t blen) | |
242 | { | |
243 | char *usbpath; | |
244 | const char *hidpath; | |
245 | hid_device *dev; | |
246 | wchar_t *serno_wch; | |
247 | int rc; | |
248 | ||
249 | if (!path || !*path) | |
250 | return SR_ERR_ARG; | |
251 | usbpath = g_strdup(path); | |
252 | hidpath = extract_hidapi_path(usbpath); | |
253 | dev = hidpath ? hid_open_path(hidpath) : NULL; | |
254 | g_free(usbpath); | |
255 | if (!dev) | |
256 | return SR_ERR_IO; | |
257 | ||
258 | serno_wch = g_malloc0(blen * sizeof(*serno_wch)); | |
259 | rc = hid_get_serial_number_string(dev, serno_wch, blen - 1); | |
260 | hid_close(dev); | |
261 | if (rc != 0) { | |
262 | g_free(serno_wch); | |
263 | return SR_ERR_IO; | |
264 | } | |
265 | ||
266 | snprintf(buf, blen, "%ls", serno_wch); | |
267 | g_free(serno_wch); | |
268 | ||
269 | return SR_OK; | |
270 | } | |
271 | ||
272 | /* Get the VID and PID of a device specified by path. */ | |
273 | static int ser_hid_hidapi_get_vid_pid(const char *path, | |
274 | uint16_t *vid, uint16_t *pid) | |
275 | { | |
276 | #if 0 | |
277 | /* | |
278 | * Bummer! It would have been most reliable to just open the | |
279 | * device by the specified path, and grab its VID:PID. But | |
280 | * there is no way to get these parameters, neither in the | |
281 | * HIDAPI itself, nor when cheating and reaching behind the API | |
282 | * and accessing the libusb handle in dirty ways. :( | |
283 | */ | |
284 | hid_device *dev; | |
285 | ||
286 | if (!path || !*path) | |
287 | return SR_ERR_ARG; | |
288 | dev = hid_open_path(path); | |
289 | if (!dev) | |
290 | return SR_ERR_IO; | |
291 | if (vid) | |
292 | *vid = dev->vendor_id; | |
293 | if (pid) | |
294 | *pid = dev->product_id; | |
295 | hid_close(dev); | |
296 | ||
297 | return SR_OK; | |
298 | #else | |
299 | /* | |
300 | * The fallback approach. Enumerate all devices, compare the | |
301 | * enumerated USB path, and grab the VID:PID. Unfortunately the | |
302 | * caller can provide path specs that differ from enumerated | |
303 | * paths yet mean the same (address the same device). This needs | |
304 | * more attention. Though the specific format of the path and | |
305 | * its meaning are said to be OS specific, which is why we may | |
306 | * not assume anything about it... | |
307 | */ | |
308 | char *usbpath; | |
309 | const char *hidpath; | |
310 | struct hid_device_info *devs, *dev; | |
311 | int found; | |
312 | ||
313 | usbpath = g_strdup(path); | |
314 | hidpath = extract_hidapi_path(usbpath); | |
315 | if (!hidpath) { | |
316 | g_free(usbpath); | |
317 | return SR_ERR_NA; | |
318 | } | |
319 | ||
320 | devs = hid_enumerate(0x0000, 0x0000); | |
321 | found = 0; | |
322 | for (dev = devs; dev; dev = dev->next) { | |
323 | if (strcmp(dev->path, hidpath) != 0) | |
324 | continue; | |
325 | if (vid) | |
326 | *vid = dev->vendor_id; | |
327 | if (pid) | |
328 | *pid = dev->product_id; | |
329 | found = 1; | |
330 | break; | |
331 | } | |
332 | hid_free_enumeration(devs); | |
333 | g_free(usbpath); | |
334 | ||
335 | return found ? SR_OK : SR_ERR_NA; | |
336 | #endif | |
337 | } | |
338 | ||
339 | static int ser_hid_hidapi_open_dev(struct sr_serial_dev_inst *serial) | |
340 | { | |
341 | hid_device *hid_dev; | |
342 | ||
343 | if (!serial->usb_path || !*serial->usb_path) | |
344 | return SR_ERR_ARG; | |
345 | ||
346 | /* | |
347 | * A path is available, assume that either a GUI or a | |
348 | * user has copied what a previous listing has provided. | |
349 | * Or a scan determined a matching device's USB path. | |
350 | */ | |
351 | if (!serial->hid_path) | |
352 | serial->hid_path = extract_hidapi_path(serial->usb_path); | |
353 | hid_dev = hid_open_path(serial->hid_path); | |
354 | sr_dbg("DBG: %s(), hid_open_path(\"%s\") => %p", __func__, | |
355 | serial->hid_path, hid_dev); | |
356 | if (!hid_dev) { | |
357 | serial->hid_path = NULL; | |
358 | return SR_ERR_IO; | |
359 | } | |
360 | ||
361 | serial->hid_dev = hid_dev; | |
362 | hid_set_nonblocking(hid_dev, 1); | |
363 | ||
364 | return SR_OK; | |
365 | } | |
366 | ||
367 | static void ser_hid_hidapi_close_dev(struct sr_serial_dev_inst *serial) | |
368 | { | |
369 | if (serial->hid_dev) { | |
370 | hid_close(serial->hid_dev); | |
371 | serial->hid_dev = NULL; | |
372 | serial->hid_path = NULL; | |
373 | } | |
374 | g_slist_free_full(serial->hid_source_args, g_free); | |
375 | serial->hid_source_args = NULL; | |
376 | } | |
377 | ||
378 | struct hidapi_source_args_t { | |
379 | /* Application callback. */ | |
380 | sr_receive_data_callback cb; | |
381 | void *cb_data; | |
382 | /* The serial device, to store RX data. */ | |
383 | struct sr_serial_dev_inst *serial; | |
384 | }; | |
385 | ||
386 | /* | |
387 | * Gets periodically invoked by the glib main loop. "Drives" (checks) | |
388 | * progress of USB communication, and invokes the application's callback | |
389 | * which processes RX data (when some has become available), as well as | |
390 | * handles application level timeouts. | |
391 | */ | |
392 | static int hidapi_source_cb(int fd, int revents, void *cb_data) | |
393 | { | |
394 | struct hidapi_source_args_t *args; | |
395 | uint8_t rx_buf[SER_HID_CHUNK_SIZE]; | |
396 | int rc; | |
397 | ||
398 | sr_dbg("DBG: %s() fd %d, evt 0x%x, data %p.", __func__, fd, revents, cb_data); | |
399 | args = cb_data; | |
400 | ||
401 | /* | |
402 | * Drain receive data which the chip might have pending. This is | |
403 | * "a copy" of the "background part" of ser_hid_read(), without | |
404 | * the timeout support code, and not knowing how much data the | |
405 | * application is expecting. | |
406 | */ | |
407 | do { | |
408 | rc = args->serial->hid_chip_funcs->read_bytes(args->serial, | |
409 | rx_buf, sizeof(rx_buf), 0); | |
410 | if (rc > 0) { | |
411 | sr_dbg("DBG: %s() queueing %d bytes.", __func__, rc); | |
412 | ser_hid_mask_databits(args->serial, rx_buf, rc); | |
413 | sr_ser_queue_rx_data(args->serial, rx_buf, rc); | |
414 | } | |
415 | } while (rc > 0); | |
416 | ||
417 | /* | |
418 | * When RX data became available (now or earlier), pass this | |
419 | * condition to the application callback. Always periodically | |
420 | * run the application callback, since it handles timeouts and | |
421 | * might carry out other tasks as well like signalling progress. | |
422 | */ | |
423 | if (sr_ser_has_queued_data(args->serial)) | |
424 | revents |= G_IO_IN; | |
425 | rc = args->cb(fd, revents, args->cb_data); | |
426 | sr_dbg("DBG: %s() rc %d.", __func__, rc); | |
427 | ||
428 | return rc; | |
429 | } | |
430 | ||
431 | #define WITH_MAXIMUM_TIMEOUT_VALUE 10 | |
432 | static int ser_hid_hidapi_setup_source_add(struct sr_session *session, | |
433 | struct sr_serial_dev_inst *serial, int events, int timeout, | |
434 | sr_receive_data_callback cb, void *cb_data) | |
435 | { | |
436 | struct hidapi_source_args_t *args; | |
437 | int rc; | |
438 | ||
439 | sr_dbg("DBG: %s() evt 0x%x, to %d.", __func__, events, timeout); | |
440 | (void)events; | |
441 | ||
442 | /* Optionally enforce a minimum poll period. */ | |
443 | if (WITH_MAXIMUM_TIMEOUT_VALUE && timeout > WITH_MAXIMUM_TIMEOUT_VALUE) | |
444 | timeout = WITH_MAXIMUM_TIMEOUT_VALUE; | |
445 | ||
446 | /* Allocate status container for background data reception. */ | |
447 | args = g_malloc0(sizeof(*args)); | |
448 | args->cb = cb; | |
449 | args->cb_data = cb_data; | |
450 | args->serial = serial; | |
451 | ||
452 | /* | |
453 | * Have a periodic timer installed. Register the allocated block | |
454 | * with the serial device, since the GSource's finalizer won't | |
455 | * free the memory, and we haven't bothered to create a custom | |
456 | * HIDAPI specific GSource. | |
457 | */ | |
458 | rc = sr_session_source_add(session, -1, events, timeout, | |
459 | hidapi_source_cb, args); | |
460 | sr_dbg("DBG: %s() added, rc %d.", __func__, rc); | |
461 | if (rc != SR_OK) { | |
462 | g_free(args); | |
463 | return rc; | |
464 | } | |
465 | serial->hid_source_args = g_slist_append(serial->hid_source_args, args); | |
466 | ||
467 | return SR_OK; | |
468 | } | |
469 | ||
470 | static int ser_hid_hidapi_setup_source_remove(struct sr_session *session, | |
471 | struct sr_serial_dev_inst *serial) | |
472 | { | |
473 | (void)serial; | |
474 | ||
475 | sr_dbg("DBG: %s().", __func__); | |
476 | (void)sr_session_source_remove(session, -1); | |
477 | /* | |
478 | * Release callback args here already? Can there be more than | |
479 | * one source registered at any time, given that we pass fd -1 | |
480 | * which is used as the key for the session? | |
481 | */ | |
482 | ||
483 | return SR_OK; | |
484 | } | |
485 | ||
486 | SR_PRIV int ser_hid_hidapi_get_report(struct sr_serial_dev_inst *serial, | |
487 | uint8_t *data, size_t len) | |
488 | { | |
489 | int rc; | |
490 | ||
491 | rc = hid_get_feature_report(serial->hid_dev, data, len); | |
492 | if (rc < 0) | |
493 | return SR_ERR_IO; | |
494 | ||
495 | return rc; | |
496 | } | |
497 | ||
498 | SR_PRIV int ser_hid_hidapi_set_report(struct sr_serial_dev_inst *serial, | |
499 | const uint8_t *data, size_t len) | |
500 | { | |
501 | int rc; | |
502 | const wchar_t *err_text; | |
503 | ||
504 | rc = hid_send_feature_report(serial->hid_dev, data, len); | |
505 | if (rc < 0) { | |
506 | err_text = hid_error(serial->hid_dev); | |
507 | sr_dbg("%s() hidapi error: %ls", __func__, err_text); | |
508 | return SR_ERR_IO; | |
509 | } | |
510 | ||
511 | return rc; | |
512 | } | |
513 | ||
514 | SR_PRIV int ser_hid_hidapi_get_data(struct sr_serial_dev_inst *serial, | |
515 | uint8_t ep, uint8_t *data, size_t len, int timeout) | |
516 | { | |
517 | int rc; | |
518 | ||
519 | (void)ep; | |
520 | ||
521 | if (timeout) | |
522 | rc = hid_read_timeout(serial->hid_dev, data, len, timeout); | |
523 | else | |
524 | rc = hid_read(serial->hid_dev, data, len); | |
525 | if (rc < 0) | |
526 | return SR_ERR_IO; | |
527 | if (rc == 0) | |
528 | return 0; | |
529 | ||
530 | return rc; | |
531 | } | |
532 | ||
533 | SR_PRIV int ser_hid_hidapi_set_data(struct sr_serial_dev_inst *serial, | |
534 | uint8_t ep, const uint8_t *data, size_t len, int timeout) | |
535 | { | |
536 | int rc; | |
537 | ||
538 | (void)ep; | |
539 | (void)timeout; | |
540 | ||
541 | rc = hid_write(serial->hid_dev, data, len); | |
542 | if (rc < 0) | |
543 | return SR_ERR_IO; | |
544 | ||
545 | return rc; | |
546 | } | |
547 | ||
548 | /* }}} */ | |
549 | /* {{{ support for serial-over-HID chips */ | |
550 | ||
551 | static struct ser_hid_chip_functions **chips[SER_HID_CHIP_LAST] = { | |
552 | [SER_HID_CHIP_UNKNOWN] = NULL, | |
a10284cd | 553 | [SER_HID_CHIP_BTC_BU86X] = &ser_hid_chip_funcs_bu86x, |
616bc3a1 | 554 | [SER_HID_CHIP_SIL_CP2110] = &ser_hid_chip_funcs_cp2110, |
0cdb72c8 | 555 | [SER_HID_CHIP_VICTOR_DMM] = &ser_hid_chip_funcs_victor, |
828eeea2 | 556 | [SER_HID_CHIP_WCH_CH9325] = &ser_hid_chip_funcs_ch9325, |
edec0436 GS |
557 | }; |
558 | ||
559 | static struct ser_hid_chip_functions *get_hid_chip_funcs(enum ser_hid_chip_t chip) | |
560 | { | |
561 | struct ser_hid_chip_functions *funcs; | |
562 | ||
563 | if (chip >= ARRAY_SIZE(chips)) | |
564 | return NULL; | |
565 | if (!chips[chip]) | |
566 | return NULL; | |
567 | funcs = *chips[chip]; | |
568 | if (!funcs) | |
569 | return NULL; | |
570 | ||
571 | return funcs; | |
572 | } | |
573 | ||
574 | static int ser_hid_setup_funcs(struct sr_serial_dev_inst *serial) | |
575 | { | |
576 | ||
577 | if (!serial) | |
578 | return -1; | |
579 | ||
580 | if (serial->hid_chip && !serial->hid_chip_funcs) { | |
581 | serial->hid_chip_funcs = get_hid_chip_funcs(serial->hid_chip); | |
582 | if (!serial->hid_chip_funcs) | |
583 | return -1; | |
584 | } | |
585 | ||
586 | return 0; | |
587 | } | |
588 | ||
589 | /* | |
590 | * Takes a pointer to the chip spec with potentially trailing data, | |
591 | * returns the chip index and advances the spec pointer upon match, | |
592 | * returns SER_HID_CHIP_UNKNOWN upon mismatch. | |
593 | */ | |
87307940 | 594 | static enum ser_hid_chip_t ser_hid_chip_find_enum(const char **spec_p) |
edec0436 | 595 | { |
87307940 | 596 | const gchar *spec; |
edec0436 GS |
597 | enum ser_hid_chip_t idx; |
598 | struct ser_hid_chip_functions *desc; | |
599 | ||
600 | if (!spec_p || !*spec_p) | |
601 | return SER_HID_CHIP_UNKNOWN; | |
602 | spec = *spec_p; | |
603 | if (!*spec) | |
604 | return SER_HID_CHIP_UNKNOWN; | |
605 | for (idx = 0; idx < SER_HID_CHIP_LAST; idx++) { | |
606 | desc = get_hid_chip_funcs(idx); | |
607 | if (!desc) | |
608 | continue; | |
609 | if (!desc->chipname) | |
610 | continue; | |
611 | if (!g_str_has_prefix(spec, desc->chipname)) | |
612 | continue; | |
613 | spec += strlen(desc->chipname); | |
614 | *spec_p = spec; | |
615 | return idx; | |
616 | } | |
617 | ||
618 | return SER_HID_CHIP_UNKNOWN; | |
619 | } | |
620 | ||
621 | /* See if we can find a chip name for a VID:PID spec. */ | |
622 | SR_PRIV const char *ser_hid_chip_find_name_vid_pid(uint16_t vid, uint16_t pid) | |
623 | { | |
624 | size_t chip_idx; | |
625 | struct ser_hid_chip_functions *desc; | |
626 | const struct vid_pid_item *vid_pids; | |
627 | ||
628 | for (chip_idx = 0; chip_idx < SER_HID_CHIP_LAST; chip_idx++) { | |
629 | desc = get_hid_chip_funcs(chip_idx); | |
630 | if (!desc) | |
631 | continue; | |
632 | if (!desc->chipname) | |
633 | continue; | |
634 | vid_pids = desc->vid_pid_items; | |
635 | if (!vid_pids) | |
636 | continue; | |
637 | while (vid_pids->vid) { | |
bf6b9e7b | 638 | if (vid_pids->vid == vid && vid_pids->pid == pid) |
edec0436 | 639 | return desc->chipname; |
edec0436 GS |
640 | vid_pids++; |
641 | } | |
642 | } | |
643 | ||
644 | return NULL; | |
645 | } | |
646 | ||
647 | static const char *ser_hid_chip_get_text(enum ser_hid_chip_t idx) | |
648 | { | |
649 | struct ser_hid_chip_functions *desc; | |
650 | ||
651 | desc = get_hid_chip_funcs(idx); | |
652 | if (!desc) | |
653 | return NULL; | |
654 | ||
655 | return desc->chipdesc; | |
656 | } | |
657 | ||
658 | /** | |
659 | * See if a text string is a valid USB path for a HID device. | |
660 | * @param[in] serial The serial port that is about to get opened. | |
661 | * @param[in] path The (assumed) USB path specification. | |
662 | * @return SR_OK upon success, SR_ERR* upon failure. | |
663 | */ | |
664 | static int try_open_path(struct sr_serial_dev_inst *serial, const char *path) | |
665 | { | |
666 | int rc; | |
667 | ||
668 | serial->usb_path = g_strdup(path); | |
669 | rc = ser_hid_hidapi_open_dev(serial); | |
670 | ser_hid_hidapi_close_dev(serial); | |
671 | g_free(serial->usb_path); | |
672 | serial->usb_path = NULL; | |
673 | ||
674 | return rc; | |
675 | } | |
676 | ||
677 | /** | |
678 | * Parse conn= specs for serial over HID communication. | |
679 | * | |
680 | * @param[in] serial The serial port that is about to get opened. | |
681 | * @param[in] spec The caller provided conn= specification. | |
682 | * @param[out] chip_ref Pointer to a chip type (enum). | |
683 | * @param[out] path_ref Pointer to a USB path (text string). | |
684 | * @param[out] serno_ref Pointer to a serial number (text string). | |
685 | * | |
686 | * @return 0 upon success, non-zero upon failure. Fills the *_ref output | |
687 | * values. | |
688 | * | |
689 | * @internal | |
690 | * | |
691 | * Summary of parsing rules as they are implemented: | |
692 | * - Insist on the "hid" prefix. Accept "hid" alone without any other | |
693 | * additional field. | |
694 | * - The first field that follows can be a chip spec, yet is optional. | |
695 | * - Any other field is assumed to be either a USB path or a serial | |
696 | * number. There is no point in specifying both of these, as either | |
697 | * of them uniquely identifies a device. | |
698 | * | |
699 | * Supported formats resulting from these rules: | |
700 | * hid[/<chip>] | |
701 | * hid[/<chip>]/usb=<bus>.<dev>[.<if>] | |
702 | * hid[/<chip>]/raw=<path> (may contain slashes!) | |
703 | * hid[/<chip>]/sn=serno | |
704 | * | |
705 | * This routine just parses the conn= spec, which either was provided by | |
706 | * a user, or may reflect (cite) an item of a previously gathered listing | |
707 | * (clipboard provided by CLI clients, or selected from a GUI form). | |
708 | * Another routine will fill in the blanks, and do the cable selection | |
709 | * when a filter was specified. | |
710 | * | |
711 | * Users will want to use short forms when they need to come up with the | |
712 | * specs by themselves. The "verbose" or seemingly redundant forms (chip | |
713 | * _and_ path/serno spec) are useful when the cable uses non-standard or | |
714 | * not-yet-supported VID:PID items when automatic chip detection fails. | |
715 | */ | |
716 | static int ser_hid_parse_conn_spec( | |
717 | struct sr_serial_dev_inst *serial, const char *spec, | |
718 | enum ser_hid_chip_t *chip_ref, char **path_ref, char **serno_ref) | |
719 | { | |
720 | const char *p; | |
721 | enum ser_hid_chip_t chip; | |
722 | char *path, *serno; | |
723 | int rc; | |
724 | ||
725 | if (chip_ref) | |
726 | *chip_ref = SER_HID_CHIP_UNKNOWN; | |
727 | if (path_ref) | |
728 | *path_ref = NULL; | |
729 | if (serno_ref) | |
730 | *serno_ref = NULL; | |
731 | chip = SER_HID_CHIP_UNKNOWN; | |
732 | path = serno = NULL; | |
733 | ||
734 | if (!serial || !spec || !*spec) | |
735 | return SR_ERR_ARG; | |
736 | sr_dbg("DBG: %s(), input spec: %s", __func__, spec); | |
737 | p = spec; | |
738 | ||
739 | /* The "hid" prefix is mandatory. */ | |
740 | if (!g_str_has_prefix(p, SER_HID_CONN_PREFIX)) { | |
741 | sr_dbg("DBG: %s(), not a HID port", __func__); | |
742 | return SR_ERR_ARG; | |
743 | } | |
744 | p += strlen(SER_HID_CONN_PREFIX); | |
745 | ||
746 | /* | |
747 | * Check for prefixed fields, assume chip type spec otherwise. | |
748 | * Paths and serial numbers "are greedy" (span to the end of | |
749 | * the input spec). Chip types are optional, and cannot repeat | |
750 | * multiple times. | |
751 | */ | |
752 | while (*p) { | |
753 | if (*p == '/') | |
754 | p++; | |
755 | if (!*p) | |
756 | break; | |
757 | if (g_str_has_prefix(p, SER_HID_USB_PREFIX)) { | |
758 | rc = try_open_path(serial, p); | |
759 | sr_dbg("DBG: %s(), open usb path %s => rc %d", __func__, p, rc); | |
760 | if (rc != SR_OK) | |
761 | return rc; | |
762 | path = g_strdup(p); | |
763 | p += strlen(p); | |
764 | } else if (g_str_has_prefix(p, SER_HID_RAW_PREFIX)) { | |
765 | rc = try_open_path(serial, p); | |
766 | sr_dbg("DBG: %s(), open raw path %s => rc %d", __func__, p, rc); | |
767 | if (rc != SR_OK) | |
768 | return rc; | |
769 | path = g_strdup(p); | |
770 | p += strlen(p); | |
771 | } else if (g_str_has_prefix(p, SER_HID_SNR_PREFIX)) { | |
772 | p += strlen(SER_HID_SNR_PREFIX); | |
773 | sr_dbg("DBG: %s(), snr %s", __func__, p); | |
774 | serno = g_strdup(p); | |
775 | p += strlen(p); | |
776 | } else if (!chip) { | |
87307940 GS |
777 | char *copy; |
778 | const char *endptr; | |
edec0436 GS |
779 | const char *name; |
780 | copy = g_strdup(p); | |
781 | endptr = copy; | |
782 | chip = ser_hid_chip_find_enum(&endptr); | |
783 | sr_dbg("DBG: %s(), chip search, %s => %u", __func__, p, chip); | |
784 | if (!chip) { | |
785 | g_free(copy); | |
786 | return SR_ERR_ARG; | |
787 | } | |
788 | p += endptr - copy; | |
789 | g_free(copy); | |
790 | name = ser_hid_chip_get_text(chip); | |
791 | sr_dbg("DBG: %s(), chip %s", __func__, name); | |
792 | } else { | |
793 | sr_err("unsupported conn= spec %s, error at %s", spec, p); | |
794 | return SR_ERR_ARG; | |
795 | } | |
796 | if (*p == '/') | |
797 | p++; | |
798 | if (path || serno) | |
799 | break; | |
800 | } | |
801 | ||
802 | sr_dbg("DBG: %s() done, chip %d, path %s, serno %s", __func__, chip, path, serno); | |
803 | if (chip_ref) | |
804 | *chip_ref = chip; | |
805 | if (path_ref && path) | |
806 | *path_ref = path; | |
807 | if (serno_ref && serno) | |
808 | *serno_ref = serno; | |
809 | ||
810 | return SR_OK; | |
811 | } | |
812 | ||
813 | /* Get and compare serial number. Boolean return value. */ | |
814 | static int check_serno(const char *path, const char *serno_want) | |
815 | { | |
816 | char *usb_path; | |
817 | const char *hid_path; | |
818 | char serno_got[128]; | |
819 | int rc; | |
820 | ||
821 | sr_dbg("DBG: %s(\"%s\", \"%s\")", __func__, path, serno_want); | |
822 | ||
823 | usb_path = g_strdup(path); | |
824 | hid_path = extract_hidapi_path(usb_path); | |
825 | rc = ser_hid_hidapi_get_serno(hid_path, serno_got, sizeof(serno_got)); | |
826 | sr_dbg("DBG: %s(), usb %s, hidapi %s => rc %d", __func__, usb_path, hid_path, rc); | |
827 | g_free(usb_path); | |
828 | if (rc) { | |
829 | sr_dbg("DBG: %s(), could not get serial number", __func__); | |
830 | return 0; | |
831 | } | |
832 | sr_dbg("DBG: %s(), got serno \"%s\"", __func__, serno_got); | |
833 | ||
834 | rc = strcmp(serno_got, serno_want) == 0; | |
835 | sr_dbg("DBG: %s(), return %d", __func__, rc); | |
836 | ||
837 | return rc; | |
838 | } | |
839 | ||
840 | static GSList *append_find(GSList *devs, const char *path) | |
841 | { | |
842 | char *copy; | |
843 | ||
844 | if (!path || !*path) | |
845 | return devs; | |
846 | ||
847 | copy = g_strdup(path); | |
848 | devs = g_slist_append(devs, copy); | |
849 | ||
850 | return devs; | |
851 | } | |
852 | ||
853 | static GSList *list_paths_for_vids_pids(const struct vid_pid_item *vid_pids) | |
854 | { | |
855 | GSList *list; | |
856 | size_t idx; | |
857 | uint16_t vid, pid; | |
858 | ||
859 | list = NULL; | |
860 | for (idx = 0; /* EMPTY */; idx++) { | |
861 | if (!vid_pids) { | |
862 | vid = pid = 0; | |
863 | } else if (!vid_pids[idx].vid) { | |
864 | break; | |
865 | } else { | |
866 | vid = vid_pids[idx].vid; | |
867 | pid = vid_pids[idx].pid; | |
868 | } | |
869 | sr_dbg("DBG: %s(), searching VID:PID %04hx:%04hx", | |
870 | __func__, vid, pid); | |
871 | list = ser_hid_hidapi_find_usb(list, append_find, vid, pid); | |
872 | if (!vid_pids) | |
873 | break; | |
874 | } | |
875 | ||
876 | return list; | |
877 | } | |
878 | ||
879 | /** | |
880 | * Search for a matching USB device for HID communication. | |
881 | * | |
882 | * @param[inout] chip The HID chip type (enum). | |
883 | * @param[inout] usbpath The USB path for the device (string). | |
884 | * @param[in] serno The serial number to search for. | |
885 | * | |
886 | * @retval SR_OK upon success | |
887 | * @retval SR_ERR_* upon failure. | |
888 | * | |
889 | * @internal | |
890 | * | |
891 | * This routine fills in blanks which the conn= spec parser left open. | |
892 | * When not specified yet, the HID chip type gets determined. When a | |
893 | * serial number was specified, then search the corresponding device. | |
894 | * Upon completion, the chip type and USB path for the device shall be | |
895 | * known, as these are essential for subsequent operation. | |
896 | */ | |
897 | static int ser_hid_chip_search(enum ser_hid_chip_t *chip_ref, | |
898 | char **path_ref, const char *serno) | |
899 | { | |
900 | enum ser_hid_chip_t chip; | |
901 | char *path; | |
902 | int have_chip, have_path, have_serno; | |
903 | struct ser_hid_chip_functions *chip_funcs; | |
904 | int rc; | |
905 | int serno_matched; | |
906 | uint16_t vid, pid; | |
907 | const char *name; | |
908 | const struct vid_pid_item *vid_pids; | |
909 | GSList *list, *matched, *matched2, *tmplist; | |
910 | ||
911 | if (!chip_ref) | |
912 | return SR_ERR_ARG; | |
913 | chip = *chip_ref; | |
914 | if (!path_ref) | |
915 | return SR_ERR_ARG; | |
916 | path = *path_ref; | |
917 | sr_dbg("DBG: %s() enter, chip %d, path %s, serno %s", __func__, | |
918 | chip, path, serno ? serno : "<none>"); | |
919 | ||
920 | /* | |
921 | * Simplify the more complex conditions somewhat by assigning | |
922 | * to local variables. Handle the easiest conditions first. | |
923 | * - Either path or serial number can be specified, but not both | |
924 | * at the same time. | |
925 | * - When a USB path is given, immediately see which HID chip | |
926 | * the device has, without the need for enumeration. | |
927 | * - When a serial number is given, enumerate the devices and | |
928 | * search for that number. Either enumerate all devices of the | |
929 | * specified HID chip type (try the VID:PID pairs that we are | |
930 | * aware of), or try all HID devices for unknown chip types. | |
931 | * Not finding the serial number is fatal. | |
932 | * - When no path was found yet, enumerate the devices and pick | |
933 | * one of them. Try known VID:PID pairs for a HID chip, or all | |
934 | * devices for unknown chips. Make sure to pick a device of a | |
935 | * supported chip type if the chip was not specified. | |
936 | * - Determine the chip type if not yet known. There should be | |
937 | * a USB path by now, determined in one of the above blocks. | |
938 | */ | |
939 | have_chip = (chip != SER_HID_CHIP_UNKNOWN) ? 1 : 0; | |
940 | have_path = (path && *path) ? 1 : 0; | |
941 | have_serno = (serno && *serno) ? 1 : 0; | |
942 | sr_dbg("DBG: %s(), have chip %d, path %d, serno %d", __func__, | |
943 | have_chip, have_path, have_serno); | |
944 | if (have_path && have_serno) { | |
945 | sr_err("Unsupported combination of USB path and serno"); | |
946 | return SR_ERR_ARG; | |
947 | } | |
948 | chip_funcs = have_chip ? get_hid_chip_funcs(chip) : NULL; | |
949 | if (have_chip && !chip_funcs) | |
950 | return SR_ERR_NA; | |
951 | if (have_chip && !chip_funcs->vid_pid_items) | |
952 | return SR_ERR_NA; | |
953 | if (have_path && !have_chip) { | |
954 | sr_dbg("DBG: %s(), searching chip for path %s", __func__, path); | |
955 | vid = pid = 0; | |
956 | rc = ser_hid_hidapi_get_vid_pid(path, &vid, &pid); | |
957 | sr_dbg("DBG: %s(), rc %d, VID:PID %04x:%04x", __func__, rc, vid, pid); | |
958 | if (rc != SR_OK) | |
959 | return rc; | |
960 | name = ser_hid_chip_find_name_vid_pid(vid, pid); | |
961 | sr_dbg("DBG: %s(), name %s", __func__, name); | |
962 | if (!name || !*name) | |
963 | return SR_ERR_NA; | |
87307940 | 964 | chip = ser_hid_chip_find_enum(&name); |
edec0436 GS |
965 | sr_dbg("DBG: %s(), chip %d", __func__, chip); |
966 | if (chip == SER_HID_CHIP_UNKNOWN) | |
967 | return SR_ERR_NA; | |
968 | have_chip = 1; | |
969 | } | |
970 | if (have_serno) { | |
971 | sr_dbg("DBG: %s(), searching path for serno %s", __func__, serno); | |
972 | vid_pids = have_chip ? chip_funcs->vid_pid_items : NULL; | |
973 | list = list_paths_for_vids_pids(vid_pids); | |
974 | sr_dbg("DBG: %s(), vid/pid list for chip type %p", __func__, list); | |
975 | if (!list) | |
976 | return SR_ERR_NA; | |
977 | matched = NULL; | |
978 | for (tmplist = list; tmplist; tmplist = tmplist->next) { | |
979 | path = get_hidapi_path_copy(tmplist->data); | |
980 | sr_dbg("DBG: %s(), checking %s", __func__, path); | |
981 | serno_matched = check_serno(path, serno); | |
982 | g_free(path); | |
983 | if (!serno_matched) | |
984 | continue; | |
985 | matched = tmplist; | |
986 | break; | |
987 | } | |
988 | if (!matched) | |
989 | return SR_ERR_NA; | |
990 | path = g_strdup(matched->data); | |
991 | sr_dbg("DBG: %s(), match, path %s", __func__, path); | |
992 | have_path = 1; | |
993 | g_slist_free_full(list, g_free); | |
994 | } | |
995 | if (!have_path) { | |
996 | sr_dbg("DBG: %s(), searching path, chip %d", __func__, chip); | |
997 | vid_pids = have_chip ? chip_funcs->vid_pid_items : NULL; | |
998 | list = list_paths_for_vids_pids(vid_pids); | |
999 | if (!list) | |
1000 | return SR_ERR_NA; | |
1001 | for (tmplist = list; tmplist; tmplist = tmplist->next) { | |
1002 | path = tmplist->data; | |
1003 | sr_dbg("DBG: %s(), path %s", __func__, path); | |
1004 | } | |
1005 | matched = matched2 = NULL; | |
1006 | if (have_chip) { | |
1007 | /* List already only contains specified chip. */ | |
1008 | matched = list; | |
1009 | path = matched->data; | |
1010 | sr_dbg("DBG: %s(), match 1 %s", __func__, path); | |
1011 | matched2 = list->next; | |
1012 | if (matched2) { | |
1013 | path = matched2->data; | |
1014 | sr_dbg("DBG: %s(), match 2 %s", __func__, path); | |
1015 | } | |
1016 | } | |
1017 | /* Works for lists with one or multiple chips. Saves indentation. */ | |
1018 | for (tmplist = list; tmplist; tmplist = tmplist->next) { | |
1019 | if (have_chip) | |
1020 | break; | |
1021 | path = tmplist->data; | |
1022 | rc = ser_hid_hidapi_get_vid_pid(path, &vid, &pid); | |
1023 | if (rc || !ser_hid_chip_find_name_vid_pid(vid, pid)) | |
1024 | continue; | |
1025 | if (!matched) { | |
1026 | matched = tmplist; | |
1027 | sr_dbg("DBG: %s(), match 1 %s", __func__, path); | |
1028 | continue; | |
1029 | } | |
1030 | if (!matched2) { | |
1031 | matched2 = tmplist; | |
1032 | sr_dbg("DBG: %s(), match 2 %s", __func__, path); | |
1033 | break; | |
1034 | } | |
1035 | } | |
1036 | if (!matched) { | |
1037 | g_slist_free_full(list, g_free); | |
1038 | return SR_ERR_NA; | |
1039 | } | |
1040 | /* | |
1041 | * TODO Optionally fail harder, expect users to provide | |
1042 | * unambiguous cable specs. | |
1043 | */ | |
1044 | if (matched2) | |
1045 | sr_info("More than one cable matches, random pick."); | |
1046 | path = get_hidapi_path_copy(matched->data); | |
1047 | sr_dbg("DBG: %s(), match, path %s", __func__, path); | |
1048 | have_path = 1; | |
1049 | g_slist_free_full(list, g_free); | |
1050 | } | |
1051 | if (have_path && !have_chip) { | |
1052 | sr_dbg("DBG: %s(), searching chip for path %s", __func__, path); | |
1053 | vid = pid = 0; | |
1054 | rc = ser_hid_hidapi_get_vid_pid(path, &vid, &pid); | |
1055 | sr_dbg("DBG: %s(), rc %d, VID:PID %04x:%04x", __func__, rc, vid, pid); | |
1056 | if (rc != SR_OK) | |
1057 | return rc; | |
1058 | name = ser_hid_chip_find_name_vid_pid(vid, pid); | |
1059 | sr_dbg("DBG: %s(), name %s", __func__, name); | |
1060 | if (!name || !*name) | |
1061 | return SR_ERR_NA; | |
87307940 | 1062 | chip = ser_hid_chip_find_enum(&name); |
edec0436 GS |
1063 | sr_dbg("DBG: %s(), chip %d", __func__, chip); |
1064 | if (chip == SER_HID_CHIP_UNKNOWN) | |
1065 | return SR_ERR_NA; | |
1066 | have_chip = 1; | |
1067 | } | |
1068 | ||
1069 | sr_dbg("DBG: %s() leave, chip %d, path %s", __func__, chip, path); | |
1070 | if (chip_ref) | |
1071 | *chip_ref = chip; | |
1072 | if (path_ref) | |
1073 | *path_ref = path; | |
1074 | ||
1075 | return SR_OK; | |
1076 | } | |
1077 | ||
1078 | /* }}} */ | |
1079 | /* {{{ transport methods called by the common serial.c code */ | |
1080 | ||
1081 | /* See if a serial port's name refers to an HID type. */ | |
1082 | SR_PRIV int ser_name_is_hid(struct sr_serial_dev_inst *serial) | |
1083 | { | |
1084 | size_t off; | |
1085 | char sep; | |
1086 | ||
1087 | if (!serial) | |
1088 | return 0; | |
1089 | if (!serial->port || !*serial->port) | |
1090 | return 0; | |
1091 | ||
1092 | /* Accept either "hid" alone, or "hid/" as a prefix. */ | |
1093 | if (!g_str_has_prefix(serial->port, SER_HID_CONN_PREFIX)) | |
1094 | return 0; | |
1095 | off = strlen(SER_HID_CONN_PREFIX); | |
1096 | sep = serial->port[off]; | |
1097 | if (sep != '\0' && sep != '/') | |
1098 | return 0; | |
1099 | ||
1100 | return 1; | |
1101 | } | |
1102 | ||
1103 | static int ser_hid_open(struct sr_serial_dev_inst *serial, int flags) | |
1104 | { | |
1105 | enum ser_hid_chip_t chip; | |
1106 | char *usbpath, *serno; | |
1107 | int rc; | |
1108 | ||
1109 | (void)flags; | |
1110 | ||
1111 | if (ser_hid_setup_funcs(serial) != 0) { | |
1112 | sr_err("Cannot determine HID communication library."); | |
1113 | return SR_ERR_NA; | |
1114 | } | |
1115 | ||
1116 | rc = ser_hid_parse_conn_spec(serial, serial->port, | |
1117 | &chip, &usbpath, &serno); | |
1118 | if (rc != SR_OK) | |
1119 | return SR_ERR_ARG; | |
1120 | ||
1121 | /* | |
1122 | * When a serial number was specified, or when the chip type or | |
1123 | * the USB path were not specified, do a search to determine the | |
1124 | * device's USB path. | |
1125 | */ | |
1126 | if (!chip || !usbpath || serno) { | |
1127 | sr_dbg("DBG: %s(), searching ...", __func__); | |
1128 | rc = ser_hid_chip_search(&chip, &usbpath, serno); | |
1129 | if (rc != 0) | |
1130 | return SR_ERR_NA; | |
1131 | } | |
1132 | ||
1133 | /* | |
1134 | * Open the HID device. Only store chip type and device handle | |
1135 | * when open completes successfully. | |
1136 | */ | |
1137 | serial->hid_chip = chip; | |
1138 | if (ser_hid_setup_funcs(serial) != 0) { | |
1139 | sr_err("Cannot determine HID chip specific routines."); | |
1140 | return SR_ERR_NA; | |
1141 | } | |
1142 | if (usbpath && *usbpath) | |
1143 | serial->usb_path = usbpath; | |
1144 | if (serno && *serno) | |
1145 | serial->usb_serno = serno; | |
1146 | ||
1147 | rc = ser_hid_hidapi_open_dev(serial); | |
1148 | if (rc) { | |
1149 | sr_err("Failed to open HID device."); | |
1150 | serial->hid_chip = 0; | |
1151 | g_free(serial->usb_path); | |
1152 | serial->usb_path = NULL; | |
1153 | g_free(serial->usb_serno); | |
1154 | serial->usb_serno = NULL; | |
1155 | return SR_ERR_IO; | |
1156 | } | |
1157 | sr_dbg("DBG: %s() done, OK", __func__); | |
1158 | ||
1159 | if (!serial->rcv_buffer) | |
1160 | serial->rcv_buffer = g_string_sized_new(SER_HID_CHUNK_SIZE); | |
1161 | ||
1162 | return SR_OK; | |
1163 | } | |
1164 | ||
1165 | static int ser_hid_close(struct sr_serial_dev_inst *serial) | |
1166 | { | |
1167 | sr_dbg("DBG: %s()", __func__); | |
1168 | ser_hid_hidapi_close_dev(serial); | |
1169 | ||
1170 | return SR_OK; | |
1171 | } | |
1172 | ||
1173 | static int ser_hid_set_params(struct sr_serial_dev_inst *serial, | |
1174 | int baudrate, int bits, int parity, int stopbits, | |
1175 | int flowcontrol, int rts, int dtr) | |
1176 | { | |
1177 | int rc; | |
1178 | ||
1179 | sr_dbg("DBG: %s() enter", __func__); | |
1180 | if (ser_hid_setup_funcs(serial) != 0) | |
1181 | return SR_ERR_NA; | |
1182 | sr_dbg("DBG: %s() chip funcs set", __func__); | |
1183 | if (!serial->hid_chip_funcs || !serial->hid_chip_funcs->set_params) | |
1184 | return SR_ERR_NA; | |
1185 | sr_dbg("DBG: %s() set params avail", __func__); | |
1186 | rc = serial->hid_chip_funcs->set_params(serial, | |
1187 | baudrate, bits, parity, stopbits, | |
1188 | flowcontrol, rts, dtr); | |
1189 | sr_dbg("DBG: %s() set params rc %d", __func__, rc); | |
1190 | ||
1191 | return rc; | |
1192 | } | |
1193 | ||
1194 | static int ser_hid_setup_source_add(struct sr_session *session, | |
1195 | struct sr_serial_dev_inst *serial, int events, int timeout, | |
1196 | sr_receive_data_callback cb, void *cb_data) | |
1197 | { | |
1198 | return ser_hid_hidapi_setup_source_add(session, serial, | |
1199 | events, timeout, cb, cb_data); | |
1200 | } | |
1201 | ||
1202 | static int ser_hid_setup_source_remove(struct sr_session *session, | |
1203 | struct sr_serial_dev_inst *serial) | |
1204 | { | |
1205 | return ser_hid_hidapi_setup_source_remove(session, serial); | |
1206 | } | |
1207 | ||
1208 | static GSList *ser_hid_list(GSList *list, sr_ser_list_append_t append) | |
1209 | { | |
1210 | return ser_hid_hidapi_list(list, append); | |
1211 | } | |
1212 | ||
1213 | static GSList *ser_hid_find_usb(GSList *list, sr_ser_find_append_t append, | |
1214 | uint16_t vendor_id, uint16_t product_id) | |
1215 | { | |
1216 | return ser_hid_hidapi_find_usb(list, append, vendor_id, product_id); | |
1217 | } | |
1218 | ||
1219 | static int ser_hid_flush(struct sr_serial_dev_inst *serial) | |
1220 | { | |
1221 | if (!serial->hid_chip_funcs || !serial->hid_chip_funcs->flush) | |
1222 | return SR_ERR_NA; | |
1223 | ||
1224 | return serial->hid_chip_funcs->flush(serial); | |
1225 | } | |
1226 | ||
1227 | static int ser_hid_drain(struct sr_serial_dev_inst *serial) | |
1228 | { | |
1229 | if (!serial->hid_chip_funcs || !serial->hid_chip_funcs->drain) | |
1230 | return SR_ERR_NA; | |
1231 | ||
1232 | return serial->hid_chip_funcs->drain(serial); | |
1233 | } | |
1234 | ||
1235 | static int ser_hid_write(struct sr_serial_dev_inst *serial, | |
1236 | const void *buf, size_t count, | |
1237 | int nonblocking, unsigned int timeout_ms) | |
1238 | { | |
1239 | int total, max_chunk, chunk_len; | |
1240 | int rc; | |
1241 | ||
1242 | if (!serial->hid_chip_funcs || !serial->hid_chip_funcs->write_bytes) | |
1243 | return SR_ERR_NA; | |
1244 | if (!serial->hid_chip_funcs->max_bytes_per_request) | |
1245 | return SR_ERR_NA; | |
1246 | ||
1247 | sr_dbg("DBG: %s() shall send %zu bytes TX data.", __func__, count); | |
1248 | total = 0; | |
1249 | max_chunk = serial->hid_chip_funcs->max_bytes_per_request; | |
1250 | while (count > 0) { | |
1251 | chunk_len = count; | |
1252 | if (max_chunk && chunk_len > max_chunk) | |
1253 | chunk_len = max_chunk; | |
1254 | rc = serial->hid_chip_funcs->write_bytes(serial, buf, chunk_len); | |
1255 | if (rc < 0) { | |
1256 | sr_err("Error sending transmit data to HID device."); | |
1257 | return total; | |
1258 | } | |
1259 | if (rc != chunk_len) { | |
1260 | sr_warn("Short transmission to HID device (%d/%d bytes)?", | |
1261 | rc, chunk_len); | |
1262 | return total; | |
1263 | } | |
1264 | buf += chunk_len; | |
1265 | count -= chunk_len; | |
1266 | total += chunk_len; | |
1267 | /* TODO | |
1268 | * Need we wait here? For data to drain through the slow | |
1269 | * UART. Not all UART-over-HID chips will have FIFOs. | |
1270 | */ | |
1271 | if (!nonblocking) { | |
1272 | (void)timeout_ms; | |
1273 | /* TODO */ | |
1274 | } | |
1275 | } | |
1276 | ||
1277 | return total; | |
1278 | } | |
1279 | ||
1280 | static int ser_hid_read(struct sr_serial_dev_inst *serial, | |
1281 | void *buf, size_t count, | |
1282 | int nonblocking, unsigned int timeout_ms) | |
1283 | { | |
1284 | gint64 deadline_us, now_us; | |
1285 | uint8_t buffer[SER_HID_CHUNK_SIZE]; | |
1286 | int rc; | |
1287 | unsigned int got; | |
1288 | ||
1289 | sr_dbg("DBG: %s() count %zd, block %d, to %u", __func__, | |
1290 | count, !nonblocking, timeout_ms); | |
1291 | ||
1292 | if (!serial->hid_chip_funcs || !serial->hid_chip_funcs->read_bytes) | |
1293 | return SR_ERR_NA; | |
1294 | if (!serial->hid_chip_funcs->max_bytes_per_request) | |
1295 | return SR_ERR_NA; | |
1296 | ||
1297 | /* | |
1298 | * Immediately satisfy the caller's request from the RX buffer | |
1299 | * if the requested amount of data is available already. | |
1300 | */ | |
bf6b9e7b UH |
1301 | if (sr_ser_has_queued_data(serial) >= count) |
1302 | return sr_ser_unqueue_rx_data(serial, buf, count); | |
edec0436 GS |
1303 | |
1304 | /* | |
1305 | * When a timeout was specified, then determine the deadline | |
1306 | * where to stop reception. | |
1307 | */ | |
1308 | deadline_us = 0; | |
1309 | now_us = 0; /* Silence a (false) compiler warning. */ | |
1310 | if (timeout_ms) { | |
1311 | now_us = g_get_monotonic_time(); | |
1312 | deadline_us = now_us + timeout_ms * 1000; | |
1313 | } | |
1314 | ||
1315 | /* | |
1316 | * Keep receiving from the port until the caller's requested | |
1317 | * amount of data has become available, or the timeout has | |
1318 | * expired. In the absence of a timeout, stop reading when an | |
1319 | * attempt no longer yields receive data. | |
1320 | * | |
1321 | * This implementation assumes that applications will call the | |
1322 | * read routine often enough, or that reception continues in | |
1323 | * background, such that data is not lost and hardware and | |
1324 | * software buffers won't overrun. | |
1325 | */ | |
1326 | while (TRUE) { | |
1327 | /* | |
1328 | * Determine the timeout (in milliseconds) for this | |
1329 | * iteration. The 'now_us' timestamp was initially | |
1330 | * determined above, and gets updated at the bottom of | |
1331 | * the loop. | |
1332 | */ | |
1333 | if (deadline_us) { | |
1334 | timeout_ms = (deadline_us - now_us) / 1000; | |
1335 | if (!timeout_ms) | |
1336 | timeout_ms = 1; | |
1337 | } else if (nonblocking) { | |
1338 | timeout_ms = 10; | |
1339 | } else { | |
1340 | timeout_ms = 0; | |
1341 | } | |
1342 | ||
1343 | /* | |
1344 | * Check the HID transport for the availability of more | |
1345 | * receive data. | |
1346 | */ | |
1347 | rc = serial->hid_chip_funcs->read_bytes(serial, | |
1348 | buffer, sizeof(buffer), timeout_ms); | |
1349 | if (rc < 0) { | |
1350 | sr_dbg("DBG: %s() read error %d.", __func__, rc); | |
1351 | return SR_ERR; | |
1352 | } | |
1353 | if (rc) { | |
1354 | sr_dbg("DBG: %s() queueing %d bytes.", __func__, rc); | |
1355 | ser_hid_mask_databits(serial, buffer, rc); | |
1356 | sr_ser_queue_rx_data(serial, buffer, rc); | |
1357 | } | |
1358 | got = sr_ser_has_queued_data(serial); | |
1359 | ||
1360 | /* | |
1361 | * Stop reading when the requested amount is available, | |
1362 | * or when the timeout has expired. | |
1363 | * | |
1364 | * TODO Consider whether grabbing all RX data is more | |
1365 | * desirable. Implementing this approach requires a cheap | |
1366 | * check for the availability of more data on the USB level. | |
1367 | */ | |
1368 | if (got >= count) | |
1369 | break; | |
1370 | if (nonblocking && !rc) | |
1371 | break; | |
1372 | if (deadline_us) { | |
1373 | now_us = g_get_monotonic_time(); | |
1374 | if (now_us >= deadline_us) { | |
1375 | sr_dbg("DBG: %s() read loop timeout.", __func__); | |
1376 | break; | |
1377 | } | |
1378 | } | |
1379 | } | |
1380 | ||
1381 | /* | |
1382 | * Satisfy the caller's demand for receive data from previously | |
1383 | * queued incoming data. | |
1384 | */ | |
1385 | if (got > count) | |
1386 | got = count; | |
1387 | sr_dbg("DBG: %s() passing %d bytes.", __func__, got); | |
edec0436 | 1388 | |
bf6b9e7b | 1389 | return sr_ser_unqueue_rx_data(serial, buf, count); |
edec0436 GS |
1390 | } |
1391 | ||
1392 | static struct ser_lib_functions serlib_hid = { | |
1393 | .open = ser_hid_open, | |
1394 | .close = ser_hid_close, | |
1395 | .flush = ser_hid_flush, | |
1396 | .drain = ser_hid_drain, | |
1397 | .write = ser_hid_write, | |
1398 | .read = ser_hid_read, | |
1399 | .set_params = ser_hid_set_params, | |
1400 | .setup_source_add = ser_hid_setup_source_add, | |
1401 | .setup_source_remove = ser_hid_setup_source_remove, | |
1402 | .list = ser_hid_list, | |
1403 | .find_usb = ser_hid_find_usb, | |
1404 | .get_frame_format = NULL, | |
1405 | }; | |
1406 | SR_PRIV struct ser_lib_functions *ser_lib_funcs_hid = &serlib_hid; | |
1407 | ||
1408 | /* }}} */ | |
1409 | #else | |
1410 | ||
4417074c GS |
1411 | SR_PRIV int ser_name_is_hid(struct sr_serial_dev_inst *serial) |
1412 | { | |
1413 | (void)serial; | |
1414 | ||
1415 | return 0; | |
1416 | } | |
1417 | ||
1418 | SR_PRIV struct ser_lib_functions *ser_lib_funcs_hid = NULL; | |
edec0436 GS |
1419 | |
1420 | #endif | |
1421 | #endif | |
1422 | /** @} */ |