]> sigrok.org Git - libsigrok.git/blame_incremental - src/hardware/fx2lafw/api.c
fx2lafw: warn on fail to open plausible devices
[libsigrok.git] / src / hardware / fx2lafw / api.c
... / ...
CommitLineData
1/*
2 * This file is part of the libsigrok project.
3 *
4 * Copyright (C) 2013 Bert Vermeulen <bert@biot.com>
5 * Copyright (C) 2012 Joel Holdsworth <joel@airwebreathe.org.uk>
6 *
7 * This program is free software: you can redistribute it and/or modify
8 * it under the terms of the GNU General Public License as published by
9 * the Free Software Foundation, either version 3 of the License, or
10 * (at your option) any later version.
11 *
12 * This program is distributed in the hope that it will be useful,
13 * but WITHOUT ANY WARRANTY; without even the implied warranty of
14 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
15 * GNU General Public License for more details.
16 *
17 * You should have received a copy of the GNU General Public License
18 * along with this program. If not, see <http://www.gnu.org/licenses/>.
19 */
20
21#include <config.h>
22#include "protocol.h"
23#include "dslogic.h"
24#include <math.h>
25
26static const struct fx2lafw_profile supported_fx2[] = {
27 /*
28 * CWAV USBee AX
29 * EE Electronics ESLA201A
30 * ARMFLY AX-Pro
31 */
32 { 0x08a9, 0x0014, "CWAV", "USBee AX", NULL,
33 "fx2lafw-cwav-usbeeax.fw",
34 DEV_CAPS_AX_ANALOG, NULL, NULL},
35 /*
36 * CWAV USBee DX
37 * XZL-Studio DX
38 */
39 { 0x08a9, 0x0015, "CWAV", "USBee DX", NULL,
40 "fx2lafw-cwav-usbeedx.fw",
41 DEV_CAPS_16BIT, NULL, NULL },
42
43 /*
44 * CWAV USBee SX
45 */
46 { 0x08a9, 0x0009, "CWAV", "USBee SX", NULL,
47 "fx2lafw-cwav-usbeesx.fw",
48 0, NULL, NULL},
49
50 /*
51 * CWAV USBee ZX
52 */
53 { 0x08a9, 0x0005, "CWAV", "USBee ZX", NULL,
54 "fx2lafw-cwav-usbeezx.fw",
55 0, NULL, NULL},
56
57 /* DreamSourceLab DSLogic (before FW upload) */
58 { 0x2a0e, 0x0001, "DreamSourceLab", "DSLogic", NULL,
59 "dreamsourcelab-dslogic-fx2.fw",
60 DEV_CAPS_16BIT, NULL, NULL},
61 /* DreamSourceLab DSLogic (after FW upload) */
62 { 0x2a0e, 0x0001, "DreamSourceLab", "DSLogic", NULL,
63 "dreamsourcelab-dslogic-fx2.fw",
64 DEV_CAPS_16BIT, "DreamSourceLab", "DSLogic"},
65
66 /* DreamSourceLab DSCope (before FW upload) */
67 { 0x2a0e, 0x0002, "DreamSourceLab", "DSCope", NULL,
68 "dreamsourcelab-dscope-fx2.fw",
69 DEV_CAPS_16BIT, NULL, NULL},
70 /* DreamSourceLab DSCope (after FW upload) */
71 { 0x2a0e, 0x0002, "DreamSourceLab", "DSCope", NULL,
72 "dreamsourcelab-dscope-fx2.fw",
73 DEV_CAPS_16BIT, "DreamSourceLab", "DSCope"},
74
75 /* DreamSourceLab DSLogic Pro (before FW upload) */
76 { 0x2a0e, 0x0003, "DreamSourceLab", "DSLogic Pro", NULL,
77 "dreamsourcelab-dslogic-pro-fx2.fw",
78 DEV_CAPS_16BIT, NULL, NULL},
79 /* DreamSourceLab DSLogic Pro (after FW upload) */
80 { 0x2a0e, 0x0003, "DreamSourceLab", "DSLogic Pro", NULL,
81 "dreamsourcelab-dslogic-pro-fx2.fw",
82 DEV_CAPS_16BIT, "DreamSourceLab", "DSLogic"},
83
84 /*
85 * Saleae Logic
86 * EE Electronics ESLA100
87 * Robomotic MiniLogic
88 * Robomotic BugLogic 3
89 */
90 { 0x0925, 0x3881, "Saleae", "Logic", NULL,
91 "fx2lafw-saleae-logic.fw",
92 0, NULL, NULL},
93
94 /*
95 * Default Cypress FX2 without EEPROM, e.g.:
96 * Lcsoft Mini Board
97 * Braintechnology USB Interface V2.x
98 */
99 { 0x04B4, 0x8613, "Cypress", "FX2", NULL,
100 "fx2lafw-cypress-fx2.fw",
101 DEV_CAPS_16BIT, NULL, NULL },
102
103 /*
104 * Braintechnology USB-LPS
105 */
106 { 0x16d0, 0x0498, "Braintechnology", "USB-LPS", NULL,
107 "fx2lafw-braintechnology-usb-lps.fw",
108 DEV_CAPS_16BIT, NULL, NULL },
109
110 /*
111 * sigrok FX2 based 8-channel logic analyzer
112 */
113 { 0x1d50, 0x608c, "sigrok", "FX2 LA (8ch)", NULL,
114 "fx2lafw-sigrok-fx2-8ch.fw",
115 0, NULL, NULL},
116
117 /*
118 * sigrok FX2 based 16-channel logic analyzer
119 */
120 { 0x1d50, 0x608d, "sigrok", "FX2 LA (16ch)", NULL,
121 "fx2lafw-sigrok-fx2-16ch.fw",
122 DEV_CAPS_16BIT, NULL, NULL },
123
124 ALL_ZERO
125};
126
127static const uint32_t drvopts[] = {
128 SR_CONF_LOGIC_ANALYZER,
129};
130
131static const uint32_t scanopts[] = {
132 SR_CONF_CONN,
133};
134
135static const uint32_t devopts[] = {
136 SR_CONF_CONTINUOUS,
137 SR_CONF_LIMIT_SAMPLES | SR_CONF_GET | SR_CONF_SET,
138 SR_CONF_CONN | SR_CONF_GET,
139 SR_CONF_SAMPLERATE | SR_CONF_GET | SR_CONF_SET | SR_CONF_LIST,
140 SR_CONF_TRIGGER_MATCH | SR_CONF_LIST,
141 SR_CONF_CAPTURE_RATIO | SR_CONF_GET | SR_CONF_SET,
142};
143
144static const uint32_t dslogic_devopts[] = {
145 SR_CONF_CONTINUOUS | SR_CONF_SET | SR_CONF_GET,
146 SR_CONF_LIMIT_SAMPLES | SR_CONF_GET | SR_CONF_SET,
147 SR_CONF_VOLTAGE_THRESHOLD | SR_CONF_GET | SR_CONF_SET | SR_CONF_LIST,
148 SR_CONF_CONN | SR_CONF_GET,
149 SR_CONF_SAMPLERATE | SR_CONF_GET | SR_CONF_SET | SR_CONF_LIST,
150 SR_CONF_TRIGGER_MATCH | SR_CONF_LIST,
151 SR_CONF_CAPTURE_RATIO | SR_CONF_GET | SR_CONF_SET,
152 SR_CONF_EXTERNAL_CLOCK | SR_CONF_GET | SR_CONF_SET,
153 SR_CONF_CLOCK_EDGE | SR_CONF_GET | SR_CONF_SET | SR_CONF_LIST,
154};
155
156static const int32_t soft_trigger_matches[] = {
157 SR_TRIGGER_ZERO,
158 SR_TRIGGER_ONE,
159 SR_TRIGGER_RISING,
160 SR_TRIGGER_FALLING,
161 SR_TRIGGER_EDGE,
162};
163
164/* Names assigned to available edge slope choices. */
165static const char *const signal_edge_names[] = {
166 [DS_EDGE_RISING] = "rising",
167 [DS_EDGE_FALLING] = "falling",
168};
169
170static const struct {
171 int range;
172 gdouble low;
173 gdouble high;
174} volt_thresholds[] = {
175 { DS_VOLTAGE_RANGE_18_33_V, 0.7, 1.4 },
176 { DS_VOLTAGE_RANGE_5_V, 1.4, 3.6 },
177};
178
179static const uint64_t samplerates[] = {
180 SR_KHZ(20),
181 SR_KHZ(25),
182 SR_KHZ(50),
183 SR_KHZ(100),
184 SR_KHZ(200),
185 SR_KHZ(250),
186 SR_KHZ(500),
187 SR_MHZ(1),
188 SR_MHZ(2),
189 SR_MHZ(3),
190 SR_MHZ(4),
191 SR_MHZ(6),
192 SR_MHZ(8),
193 SR_MHZ(12),
194 SR_MHZ(16),
195 SR_MHZ(24),
196};
197
198static const uint64_t dslogic_samplerates[] = {
199 SR_KHZ(10),
200 SR_KHZ(20),
201 SR_KHZ(50),
202 SR_KHZ(100),
203 SR_KHZ(200),
204 SR_KHZ(500),
205 SR_MHZ(1),
206 SR_MHZ(2),
207 SR_MHZ(5),
208 SR_MHZ(10),
209 SR_MHZ(20),
210 SR_MHZ(25),
211 SR_MHZ(50),
212 SR_MHZ(100),
213 SR_MHZ(200),
214 SR_MHZ(400),
215};
216
217static gboolean is_plausible(const struct libusb_device_descriptor *des)
218{
219 int i;
220
221 for (i = 0; supported_fx2[i].vid; i++) {
222 if (des->idVendor != supported_fx2[i].vid)
223 continue;
224 if (des->idProduct == supported_fx2[i].pid)
225 return TRUE;
226 }
227
228 return FALSE;
229}
230
231static GSList *scan(struct sr_dev_driver *di, GSList *options)
232{
233 struct drv_context *drvc;
234 struct dev_context *devc;
235 struct sr_dev_inst *sdi;
236 struct sr_usb_dev_inst *usb;
237 struct sr_channel *ch;
238 struct sr_channel_group *cg;
239 struct sr_config *src;
240 const struct fx2lafw_profile *prof;
241 GSList *l, *devices, *conn_devices;
242 gboolean has_firmware;
243 struct libusb_device_descriptor des;
244 libusb_device **devlist;
245 struct libusb_device_handle *hdl;
246 int ret, i, j;
247 int num_logic_channels = 0, num_analog_channels = 0;
248 const char *conn;
249 char manufacturer[64], product[64], serial_num[64], connection_id[64];
250 char channel_name[16];
251
252 drvc = di->context;
253
254 conn = NULL;
255 for (l = options; l; l = l->next) {
256 src = l->data;
257 switch (src->key) {
258 case SR_CONF_CONN:
259 conn = g_variant_get_string(src->data, NULL);
260 break;
261 }
262 }
263 if (conn)
264 conn_devices = sr_usb_find(drvc->sr_ctx->libusb_ctx, conn);
265 else
266 conn_devices = NULL;
267
268 /* Find all fx2lafw compatible devices and upload firmware to them. */
269 devices = NULL;
270 libusb_get_device_list(drvc->sr_ctx->libusb_ctx, &devlist);
271 for (i = 0; devlist[i]; i++) {
272 if (conn) {
273 usb = NULL;
274 for (l = conn_devices; l; l = l->next) {
275 usb = l->data;
276 if (usb->bus == libusb_get_bus_number(devlist[i])
277 && usb->address == libusb_get_device_address(devlist[i]))
278 break;
279 }
280 if (!l)
281 /* This device matched none of the ones that
282 * matched the conn specification. */
283 continue;
284 }
285
286 libusb_get_device_descriptor( devlist[i], &des);
287
288 if (!is_plausible(&des))
289 continue;
290
291 if ((ret = libusb_open(devlist[i], &hdl)) < 0) {
292 sr_warn("Failed to open potential device with "
293 "VID:PID %04x:%04x: %s.", des.idVendor,
294 des.idProduct, libusb_error_name(ret));
295 continue;
296 }
297
298 if (des.iManufacturer == 0) {
299 manufacturer[0] = '\0';
300 } else if ((ret = libusb_get_string_descriptor_ascii(hdl,
301 des.iManufacturer, (unsigned char *) manufacturer,
302 sizeof(manufacturer))) < 0) {
303 sr_warn("Failed to get manufacturer string descriptor: %s.",
304 libusb_error_name(ret));
305 continue;
306 }
307
308 if (des.iProduct == 0) {
309 product[0] = '\0';
310 } else if ((ret = libusb_get_string_descriptor_ascii(hdl,
311 des.iProduct, (unsigned char *) product,
312 sizeof(product))) < 0) {
313 sr_warn("Failed to get product string descriptor: %s.",
314 libusb_error_name(ret));
315 continue;
316 }
317
318 if (des.iSerialNumber == 0) {
319 serial_num[0] = '\0';
320 } else if ((ret = libusb_get_string_descriptor_ascii(hdl,
321 des.iSerialNumber, (unsigned char *) serial_num,
322 sizeof(serial_num))) < 0) {
323 sr_warn("Failed to get serial number string descriptor: %s.",
324 libusb_error_name(ret));
325 continue;
326 }
327
328 usb_get_port_path(devlist[i], connection_id, sizeof(connection_id));
329
330 libusb_close(hdl);
331
332 prof = NULL;
333 for (j = 0; supported_fx2[j].vid; j++) {
334 if (des.idVendor == supported_fx2[j].vid &&
335 des.idProduct == supported_fx2[j].pid &&
336 (!supported_fx2[j].usb_manufacturer ||
337 !strcmp(manufacturer, supported_fx2[j].usb_manufacturer)) &&
338 (!supported_fx2[j].usb_manufacturer ||
339 !strcmp(product, supported_fx2[j].usb_product))) {
340 prof = &supported_fx2[j];
341 break;
342 }
343 }
344
345 /* Skip if the device was not found. */
346 if (!prof)
347 continue;
348
349 sdi = g_malloc0(sizeof(struct sr_dev_inst));
350 sdi->status = SR_ST_INITIALIZING;
351 sdi->vendor = g_strdup(prof->vendor);
352 sdi->model = g_strdup(prof->model);
353 sdi->version = g_strdup(prof->model_version);
354 sdi->serial_num = g_strdup(serial_num);
355 sdi->connection_id = g_strdup(connection_id);
356
357 /* Fill in channellist according to this device's profile. */
358 num_logic_channels = prof->dev_caps & DEV_CAPS_16BIT ? 16 : 8;
359 num_analog_channels = prof->dev_caps & DEV_CAPS_AX_ANALOG ? 1 : 0;
360
361 /* Logic channels, all in one channel group. */
362 cg = g_malloc0(sizeof(struct sr_channel_group));
363 cg->name = g_strdup("Logic");
364 for (j = 0; j < num_logic_channels; j++) {
365 sprintf(channel_name, "D%d", j);
366 ch = sr_channel_new(sdi, j, SR_CHANNEL_LOGIC,
367 TRUE, channel_name);
368 cg->channels = g_slist_append(cg->channels, ch);
369 }
370 sdi->channel_groups = g_slist_append(NULL, cg);
371
372 for (j = 0; j < num_analog_channels; j++) {
373 snprintf(channel_name, 16, "A%d", j);
374 ch = sr_channel_new(sdi, j + num_logic_channels,
375 SR_CHANNEL_ANALOG, TRUE, channel_name);
376
377 /* Every analog channel gets its own channel group. */
378 cg = g_malloc0(sizeof(struct sr_channel_group));
379 cg->name = g_strdup(channel_name);
380 cg->channels = g_slist_append(NULL, ch);
381 sdi->channel_groups = g_slist_append(sdi->channel_groups, cg);
382 }
383
384 devc = fx2lafw_dev_new();
385 devc->profile = prof;
386 if ((prof->dev_caps & DEV_CAPS_16BIT) || (prof->dev_caps & DEV_CAPS_AX_ANALOG))
387 devc->sample_wide = TRUE;
388 sdi->priv = devc;
389 devices = g_slist_append(devices, sdi);
390
391 if (!strcmp(prof->model, "DSLogic")
392 || !strcmp(prof->model, "DSLogic Pro")
393 || !strcmp(prof->model, "DSCope")) {
394 devc->dslogic = TRUE;
395 devc->samplerates = dslogic_samplerates;
396 devc->num_samplerates = ARRAY_SIZE(dslogic_samplerates);
397 has_firmware = match_manuf_prod(devlist[i], "DreamSourceLab", "DSLogic")
398 || match_manuf_prod(devlist[i], "DreamSourceLab", "DSCope");
399 } else {
400 devc->dslogic = FALSE;
401 devc->samplerates = samplerates;
402 devc->num_samplerates = ARRAY_SIZE(samplerates);
403 has_firmware = match_manuf_prod(devlist[i],
404 "sigrok", "fx2lafw");
405 }
406
407 if (has_firmware) {
408 /* Already has the firmware, so fix the new address. */
409 sr_dbg("Found an fx2lafw device.");
410 sdi->status = SR_ST_INACTIVE;
411 sdi->inst_type = SR_INST_USB;
412 sdi->conn = sr_usb_dev_inst_new(libusb_get_bus_number(devlist[i]),
413 libusb_get_device_address(devlist[i]), NULL);
414 } else {
415 if (ezusb_upload_firmware(drvc->sr_ctx, devlist[i],
416 USB_CONFIGURATION, prof->firmware) == SR_OK)
417 /* Store when this device's FW was updated. */
418 devc->fw_updated = g_get_monotonic_time();
419 else
420 sr_err("Firmware upload failed for "
421 "device %d.%d (logical).",
422 libusb_get_bus_number(devlist[i]),
423 libusb_get_device_address(devlist[i]));
424 sdi->inst_type = SR_INST_USB;
425 sdi->conn = sr_usb_dev_inst_new(libusb_get_bus_number(devlist[i]),
426 0xff, NULL);
427 }
428 }
429 libusb_free_device_list(devlist, 1);
430 g_slist_free_full(conn_devices, (GDestroyNotify)sr_usb_dev_inst_free);
431
432 return std_scan_complete(di, devices);
433}
434
435static void clear_dev_context(void *priv)
436{
437 struct dev_context *devc;
438
439 devc = priv;
440 g_slist_free(devc->enabled_analog_channels);
441 g_free(devc);
442}
443
444static int dev_clear(const struct sr_dev_driver *di)
445{
446 return std_dev_clear(di, clear_dev_context);
447}
448
449static int dev_open(struct sr_dev_inst *sdi)
450{
451 struct sr_dev_driver *di = sdi->driver;
452 struct sr_usb_dev_inst *usb;
453 struct dev_context *devc;
454 const char *fpga_firmware = NULL;
455 int ret;
456 int64_t timediff_us, timediff_ms;
457
458 devc = sdi->priv;
459 usb = sdi->conn;
460
461 /*
462 * If the firmware was recently uploaded, wait up to MAX_RENUM_DELAY_MS
463 * milliseconds for the FX2 to renumerate.
464 */
465 ret = SR_ERR;
466 if (devc->fw_updated > 0) {
467 sr_info("Waiting for device to reset.");
468 /* Takes >= 300ms for the FX2 to be gone from the USB bus. */
469 g_usleep(300 * 1000);
470 timediff_ms = 0;
471 while (timediff_ms < MAX_RENUM_DELAY_MS) {
472 if ((ret = fx2lafw_dev_open(sdi, di)) == SR_OK)
473 break;
474 g_usleep(100 * 1000);
475
476 timediff_us = g_get_monotonic_time() - devc->fw_updated;
477 timediff_ms = timediff_us / 1000;
478 sr_spew("Waited %" PRIi64 "ms.", timediff_ms);
479 }
480 if (ret != SR_OK) {
481 sr_err("Device failed to renumerate.");
482 return SR_ERR;
483 }
484 sr_info("Device came back after %" PRIi64 "ms.", timediff_ms);
485 } else {
486 sr_info("Firmware upload was not needed.");
487 ret = fx2lafw_dev_open(sdi, di);
488 }
489
490 if (ret != SR_OK) {
491 sr_err("Unable to open device.");
492 return SR_ERR;
493 }
494
495 ret = libusb_claim_interface(usb->devhdl, USB_INTERFACE);
496 if (ret != 0) {
497 switch (ret) {
498 case LIBUSB_ERROR_BUSY:
499 sr_err("Unable to claim USB interface. Another "
500 "program or driver has already claimed it.");
501 break;
502 case LIBUSB_ERROR_NO_DEVICE:
503 sr_err("Device has been disconnected.");
504 break;
505 default:
506 sr_err("Unable to claim interface: %s.",
507 libusb_error_name(ret));
508 break;
509 }
510
511 return SR_ERR;
512 }
513
514 if (devc->dslogic) {
515 if (!strcmp(devc->profile->model, "DSLogic")) {
516 if (devc->dslogic_voltage_threshold == DS_VOLTAGE_RANGE_18_33_V)
517 fpga_firmware = DSLOGIC_FPGA_FIRMWARE_3V3;
518 else
519 fpga_firmware = DSLOGIC_FPGA_FIRMWARE_5V;
520 } else if (!strcmp(devc->profile->model, "DSLogic Pro")){
521 fpga_firmware = DSLOGIC_PRO_FPGA_FIRMWARE;
522 } else if (!strcmp(devc->profile->model, "DSCope")) {
523 fpga_firmware = DSCOPE_FPGA_FIRMWARE;
524 }
525
526 if ((ret = dslogic_fpga_firmware_upload(sdi, fpga_firmware)) != SR_OK)
527 return ret;
528 }
529 if (devc->cur_samplerate == 0) {
530 /* Samplerate hasn't been set; default to the slowest one. */
531 devc->cur_samplerate = devc->samplerates[0];
532 }
533
534 return SR_OK;
535}
536
537static int dev_close(struct sr_dev_inst *sdi)
538{
539 struct sr_usb_dev_inst *usb;
540
541 usb = sdi->conn;
542
543 if (!usb->devhdl)
544 return SR_ERR;
545
546 sr_info("fx2lafw: Closing device on %d.%d (logical) / %s (physical) interface %d.",
547 usb->bus, usb->address, sdi->connection_id, USB_INTERFACE);
548 libusb_release_interface(usb->devhdl, USB_INTERFACE);
549 libusb_close(usb->devhdl);
550 usb->devhdl = NULL;
551 sdi->status = SR_ST_INACTIVE;
552
553 return SR_OK;
554}
555
556static int config_get(uint32_t key, GVariant **data,
557 const struct sr_dev_inst *sdi, const struct sr_channel_group *cg)
558{
559 struct dev_context *devc;
560 struct sr_usb_dev_inst *usb;
561 GVariant *range[2];
562 unsigned int i;
563 char str[128];
564
565 (void)cg;
566
567 if (!sdi)
568 return SR_ERR_ARG;
569
570 devc = sdi->priv;
571
572 switch (key) {
573 case SR_CONF_CONN:
574 if (!sdi->conn)
575 return SR_ERR_ARG;
576 usb = sdi->conn;
577 if (usb->address == 255)
578 /* Device still needs to re-enumerate after firmware
579 * upload, so we don't know its (future) address. */
580 return SR_ERR;
581 snprintf(str, 128, "%d.%d", usb->bus, usb->address);
582 *data = g_variant_new_string(str);
583 break;
584 case SR_CONF_VOLTAGE_THRESHOLD:
585 for (i = 0; i < ARRAY_SIZE(volt_thresholds); i++) {
586 if (volt_thresholds[i].range != devc->dslogic_voltage_threshold)
587 continue;
588 range[0] = g_variant_new_double(volt_thresholds[i].low);
589 range[1] = g_variant_new_double(volt_thresholds[i].high);
590 *data = g_variant_new_tuple(range, 2);
591 break;
592 }
593 break;
594 case SR_CONF_LIMIT_SAMPLES:
595 *data = g_variant_new_uint64(devc->limit_samples);
596 break;
597 case SR_CONF_SAMPLERATE:
598 *data = g_variant_new_uint64(devc->cur_samplerate);
599 break;
600 case SR_CONF_CAPTURE_RATIO:
601 *data = g_variant_new_uint64(devc->capture_ratio);
602 break;
603 case SR_CONF_EXTERNAL_CLOCK:
604 *data = g_variant_new_boolean(devc->dslogic_external_clock);
605 break;
606 case SR_CONF_CONTINUOUS:
607 *data = g_variant_new_boolean(devc->dslogic_continuous_mode);
608 break;
609 case SR_CONF_CLOCK_EDGE:
610 i = devc->dslogic_clock_edge;
611 if (i >= ARRAY_SIZE(signal_edge_names))
612 return SR_ERR_BUG;
613 *data = g_variant_new_string(signal_edge_names[0]);
614 break;
615 default:
616 return SR_ERR_NA;
617 }
618
619 return SR_OK;
620}
621
622/*
623 * Helper for mapping a string-typed configuration value to an index
624 * within a table of possible values.
625 */
626static int lookup_index(GVariant *value, const char *const *table, int len)
627{
628 const char *entry;
629 int i;
630
631 entry = g_variant_get_string(value, NULL);
632 if (!entry)
633 return -1;
634
635 /* Linear search is fine for very small tables. */
636 for (i = 0; i < len; i++) {
637 if (strcmp(entry, table[i]) == 0)
638 return i;
639 }
640
641 return -1;
642}
643
644static int config_set(uint32_t key, GVariant *data,
645 const struct sr_dev_inst *sdi, const struct sr_channel_group *cg)
646{
647 struct dev_context *devc;
648 uint64_t arg;
649 int i, ret;
650 gdouble low, high;
651
652 (void)cg;
653
654 if (!sdi)
655 return SR_ERR_ARG;
656
657 if (sdi->status != SR_ST_ACTIVE)
658 return SR_ERR;
659
660 devc = sdi->priv;
661
662 ret = SR_OK;
663
664 switch (key) {
665 case SR_CONF_SAMPLERATE:
666 arg = g_variant_get_uint64(data);
667 for (i = 0; i < devc->num_samplerates; i++) {
668 if (devc->samplerates[i] == arg) {
669 devc->cur_samplerate = arg;
670 break;
671 }
672 }
673 if (i == devc->num_samplerates)
674 ret = SR_ERR_ARG;
675 break;
676 case SR_CONF_LIMIT_SAMPLES:
677 devc->limit_samples = g_variant_get_uint64(data);
678 break;
679 case SR_CONF_CAPTURE_RATIO:
680 devc->capture_ratio = g_variant_get_uint64(data);
681 ret = (devc->capture_ratio > 100) ? SR_ERR : SR_OK;
682 break;
683 case SR_CONF_VOLTAGE_THRESHOLD:
684 g_variant_get(data, "(dd)", &low, &high);
685 ret = SR_ERR_ARG;
686 for (i = 0; (unsigned int)i < ARRAY_SIZE(volt_thresholds); i++) {
687 if (fabs(volt_thresholds[i].low - low) < 0.1 &&
688 fabs(volt_thresholds[i].high - high) < 0.1) {
689 devc->dslogic_voltage_threshold = volt_thresholds[i].range;
690 break;
691 }
692 }
693 if (!strcmp(devc->profile->model, "DSLogic")) {
694 if (devc->dslogic_voltage_threshold == DS_VOLTAGE_RANGE_5_V)
695 ret = dslogic_fpga_firmware_upload(sdi, DSLOGIC_FPGA_FIRMWARE_5V);
696 else
697 ret = dslogic_fpga_firmware_upload(sdi, DSLOGIC_FPGA_FIRMWARE_3V3);
698 } else if (!strcmp(devc->profile->model, "DSLogic Pro")) {
699 ret = dslogic_fpga_firmware_upload(sdi, DSLOGIC_PRO_FPGA_FIRMWARE);
700 }
701 break;
702 case SR_CONF_EXTERNAL_CLOCK:
703 devc->dslogic_external_clock = g_variant_get_boolean(data);
704 break;
705 case SR_CONF_CONTINUOUS:
706 devc->dslogic_continuous_mode = g_variant_get_boolean(data);
707 break;
708 case SR_CONF_CLOCK_EDGE:
709 i = lookup_index(data, signal_edge_names,
710 ARRAY_SIZE(signal_edge_names));
711 if (i < 0)
712 return SR_ERR_ARG;
713 devc->dslogic_clock_edge = i;
714 break;
715 default:
716 ret = SR_ERR_NA;
717 }
718
719 return ret;
720}
721
722static int config_list(uint32_t key, GVariant **data,
723 const struct sr_dev_inst *sdi, const struct sr_channel_group *cg)
724{
725 struct dev_context *devc;
726 GVariant *gvar, *range[2];
727 GVariantBuilder gvb;
728 unsigned int i;
729
730 (void)cg;
731
732 switch (key) {
733 case SR_CONF_SCAN_OPTIONS:
734 *data = g_variant_new_fixed_array(G_VARIANT_TYPE_UINT32,
735 scanopts, ARRAY_SIZE(scanopts), sizeof(uint32_t));
736 break;
737 case SR_CONF_DEVICE_OPTIONS:
738 if (!sdi) {
739 *data = g_variant_new_fixed_array(G_VARIANT_TYPE_UINT32,
740 drvopts, ARRAY_SIZE(drvopts), sizeof(uint32_t));
741 } else {
742 devc = sdi->priv;
743 if (!devc->dslogic)
744 *data = g_variant_new_fixed_array(G_VARIANT_TYPE_UINT32,
745 devopts, ARRAY_SIZE(devopts), sizeof(uint32_t));
746 else
747 *data = g_variant_new_fixed_array(G_VARIANT_TYPE_UINT32,
748 dslogic_devopts, ARRAY_SIZE(dslogic_devopts), sizeof(uint32_t));
749 }
750 break;
751 case SR_CONF_VOLTAGE_THRESHOLD:
752 if (!sdi->priv)
753 return SR_ERR_ARG;
754 devc = sdi->priv;
755 if (!devc->dslogic)
756 return SR_ERR_NA;
757 g_variant_builder_init(&gvb, G_VARIANT_TYPE_ARRAY);
758 for (i = 0; i < ARRAY_SIZE(volt_thresholds); i++) {
759 range[0] = g_variant_new_double(volt_thresholds[i].low);
760 range[1] = g_variant_new_double(volt_thresholds[i].high);
761 gvar = g_variant_new_tuple(range, 2);
762 g_variant_builder_add_value(&gvb, gvar);
763 }
764 *data = g_variant_builder_end(&gvb);
765 break;
766 case SR_CONF_SAMPLERATE:
767 devc = sdi->priv;
768 g_variant_builder_init(&gvb, G_VARIANT_TYPE("a{sv}"));
769 gvar = g_variant_new_fixed_array(G_VARIANT_TYPE("t"), devc->samplerates,
770 devc->num_samplerates, sizeof(uint64_t));
771 g_variant_builder_add(&gvb, "{sv}", "samplerates", gvar);
772 *data = g_variant_builder_end(&gvb);
773 break;
774 case SR_CONF_TRIGGER_MATCH:
775 *data = g_variant_new_fixed_array(G_VARIANT_TYPE_INT32,
776 soft_trigger_matches, ARRAY_SIZE(soft_trigger_matches),
777 sizeof(int32_t));
778 break;
779 case SR_CONF_CLOCK_EDGE:
780 *data = g_variant_new_strv(signal_edge_names,
781 ARRAY_SIZE(signal_edge_names));
782 break;
783 default:
784 return SR_ERR_NA;
785 }
786
787 return SR_OK;
788}
789
790static int receive_data(int fd, int revents, void *cb_data)
791{
792 struct timeval tv;
793 struct drv_context *drvc;
794
795 (void)fd;
796 (void)revents;
797
798 drvc = (struct drv_context *)cb_data;
799
800 tv.tv_sec = tv.tv_usec = 0;
801 libusb_handle_events_timeout(drvc->sr_ctx->libusb_ctx, &tv);
802
803 return TRUE;
804}
805
806static int start_transfers(const struct sr_dev_inst *sdi)
807{
808 struct dev_context *devc;
809 struct sr_usb_dev_inst *usb;
810 struct sr_trigger *trigger;
811 struct libusb_transfer *transfer;
812 unsigned int i, num_transfers;
813 int endpoint, timeout, ret;
814 unsigned char *buf;
815 size_t size;
816
817 devc = sdi->priv;
818 usb = sdi->conn;
819
820 devc->sent_samples = 0;
821 devc->acq_aborted = FALSE;
822 devc->empty_transfer_count = 0;
823
824 if ((trigger = sr_session_trigger_get(sdi->session)) && !devc->dslogic) {
825 int pre_trigger_samples = 0;
826 if (devc->limit_samples > 0)
827 pre_trigger_samples = devc->capture_ratio * devc->limit_samples/100;
828 devc->stl = soft_trigger_logic_new(sdi, trigger, pre_trigger_samples);
829 if (!devc->stl)
830 return SR_ERR_MALLOC;
831 devc->trigger_fired = FALSE;
832 } else
833 devc->trigger_fired = TRUE;
834
835 num_transfers = fx2lafw_get_number_of_transfers(devc);
836
837 //if (devc->dslogic)
838 // num_transfers = dslogic_get_number_of_transfers(devc);
839
840 if (devc->dslogic) {
841 if (devc->cur_samplerate == SR_MHZ(100))
842 num_transfers = 16;
843 else if (devc->cur_samplerate == SR_MHZ(200))
844 num_transfers = 8;
845 else if (devc->cur_samplerate == SR_MHZ(400))
846 num_transfers = 4;
847 }
848
849 size = fx2lafw_get_buffer_size(devc);
850 devc->submitted_transfers = 0;
851
852 devc->transfers = g_try_malloc0(sizeof(*devc->transfers) * num_transfers);
853 if (!devc->transfers) {
854 sr_err("USB transfers malloc failed.");
855 return SR_ERR_MALLOC;
856 }
857
858 timeout = fx2lafw_get_timeout(devc);
859 endpoint = devc->dslogic ? 6 : 2;
860 devc->num_transfers = num_transfers;
861 for (i = 0; i < num_transfers; i++) {
862 if (!(buf = g_try_malloc(size))) {
863 sr_err("USB transfer buffer malloc failed.");
864 return SR_ERR_MALLOC;
865 }
866 transfer = libusb_alloc_transfer(0);
867 libusb_fill_bulk_transfer(transfer, usb->devhdl,
868 endpoint | LIBUSB_ENDPOINT_IN, buf, size,
869 fx2lafw_receive_transfer, (void *)sdi, timeout);
870 sr_info("submitting transfer: %d", i);
871 if ((ret = libusb_submit_transfer(transfer)) != 0) {
872 sr_err("Failed to submit transfer: %s.",
873 libusb_error_name(ret));
874 libusb_free_transfer(transfer);
875 g_free(buf);
876 fx2lafw_abort_acquisition(devc);
877 return SR_ERR;
878 }
879 devc->transfers[i] = transfer;
880 devc->submitted_transfers++;
881 }
882
883 if (devc->profile->dev_caps & DEV_CAPS_AX_ANALOG)
884 devc->send_data_proc = mso_send_data_proc;
885 else
886 devc->send_data_proc = la_send_data_proc;
887
888 std_session_send_df_header(sdi);
889
890 return SR_OK;
891}
892
893static void LIBUSB_CALL dslogic_trigger_receive(struct libusb_transfer *transfer)
894{
895 const struct sr_dev_inst *sdi;
896 struct dslogic_trigger_pos *tpos;
897 struct dev_context *devc;
898
899 sdi = transfer->user_data;
900 devc = sdi->priv;
901 if (transfer->status == LIBUSB_TRANSFER_CANCELLED) {
902 sr_dbg("Trigger transfer canceled.");
903 /* Terminate session. */
904 std_session_send_df_end(sdi);
905 usb_source_remove(sdi->session, devc->ctx);
906 devc->num_transfers = 0;
907 g_free(devc->transfers);
908 if (devc->stl) {
909 soft_trigger_logic_free(devc->stl);
910 devc->stl = NULL;
911 }
912 } else if (transfer->status == LIBUSB_TRANSFER_COMPLETED
913 && transfer->actual_length == sizeof(struct dslogic_trigger_pos)) {
914 tpos = (struct dslogic_trigger_pos *)transfer->buffer;
915 sr_info("tpos real_pos %d ram_saddr %d cnt %d", tpos->real_pos,
916 tpos->ram_saddr, tpos->remain_cnt);
917 devc->trigger_pos = tpos->real_pos;
918 g_free(tpos);
919 start_transfers(sdi);
920 }
921 libusb_free_transfer(transfer);
922}
923
924static int dslogic_trigger_request(const struct sr_dev_inst *sdi)
925{
926 struct sr_usb_dev_inst *usb;
927 struct libusb_transfer *transfer;
928 struct dslogic_trigger_pos *tpos;
929 struct dev_context *devc;
930 int ret;
931
932 usb = sdi->conn;
933 devc = sdi->priv;
934
935 if ((ret = dslogic_stop_acquisition(sdi)) != SR_OK)
936 return ret;
937
938 if ((ret = dslogic_fpga_configure(sdi)) != SR_OK)
939 return ret;
940
941 /* If this is a DSLogic Pro, set the voltage threshold. */
942 if (!strcmp(devc->profile->model, "DSLogic Pro")){
943 if (devc->dslogic_voltage_threshold == DS_VOLTAGE_RANGE_18_33_V) {
944 dslogic_set_vth(sdi, 1.4);
945 } else {
946 dslogic_set_vth(sdi, 3.3);
947 }
948 }
949
950 if ((ret = dslogic_start_acquisition(sdi)) != SR_OK)
951 return ret;
952
953 sr_dbg("Getting trigger.");
954 tpos = g_malloc(sizeof(struct dslogic_trigger_pos));
955 transfer = libusb_alloc_transfer(0);
956 libusb_fill_bulk_transfer(transfer, usb->devhdl, 6 | LIBUSB_ENDPOINT_IN,
957 (unsigned char *)tpos, sizeof(struct dslogic_trigger_pos),
958 dslogic_trigger_receive, (void *)sdi, 0);
959 if ((ret = libusb_submit_transfer(transfer)) < 0) {
960 sr_err("Failed to request trigger: %s.", libusb_error_name(ret));
961 libusb_free_transfer(transfer);
962 g_free(tpos);
963 return SR_ERR;
964 }
965
966 devc->transfers = g_try_malloc0(sizeof(*devc->transfers));
967 if (!devc->transfers) {
968 sr_err("USB trigger_pos transfer malloc failed.");
969 return SR_ERR_MALLOC;
970 }
971 devc->num_transfers = 1;
972 devc->submitted_transfers++;
973 devc->transfers[0] = transfer;
974
975 return ret;
976}
977
978static int configure_channels(const struct sr_dev_inst *sdi)
979{
980 struct dev_context *devc;
981 const GSList *l;
982 int p;
983 struct sr_channel *ch;
984
985 devc = sdi->priv;
986
987 g_slist_free(devc->enabled_analog_channels);
988 devc->enabled_analog_channels = NULL;
989 memset(devc->ch_enabled, 0, sizeof(devc->ch_enabled));
990
991 for (l = sdi->channels, p = 0; l; l = l->next, p++) {
992 ch = l->data;
993 if ((p <= NUM_CHANNELS) && (ch->type == SR_CHANNEL_ANALOG)) {
994 devc->ch_enabled[p] = ch->enabled;
995 devc->enabled_analog_channels =
996 g_slist_append(devc->enabled_analog_channels, ch);
997 }
998 }
999
1000 return SR_OK;
1001}
1002
1003static int dev_acquisition_start(const struct sr_dev_inst *sdi)
1004{
1005 struct sr_dev_driver *di;
1006 struct drv_context *drvc;
1007 struct dev_context *devc;
1008 int timeout, ret;
1009 size_t size;
1010
1011 if (sdi->status != SR_ST_ACTIVE)
1012 return SR_ERR_DEV_CLOSED;
1013
1014 di = sdi->driver;
1015 drvc = di->context;
1016 devc = sdi->priv;
1017
1018 devc->ctx = drvc->sr_ctx;
1019 devc->sent_samples = 0;
1020 devc->empty_transfer_count = 0;
1021 devc->acq_aborted = FALSE;
1022
1023 if (configure_channels(sdi) != SR_OK) {
1024 sr_err("Failed to configure channels.");
1025 return SR_ERR;
1026 }
1027
1028 timeout = fx2lafw_get_timeout(devc);
1029 usb_source_add(sdi->session, devc->ctx, timeout, receive_data, drvc);
1030
1031 if (devc->dslogic) {
1032 dslogic_trigger_request(sdi);
1033 } else {
1034 size = fx2lafw_get_buffer_size(devc);
1035 /* Prepare for analog sampling. */
1036 if (devc->profile->dev_caps & DEV_CAPS_AX_ANALOG) {
1037 /* We need a buffer half the size of a transfer. */
1038 devc->logic_buffer = g_try_malloc(size / 2);
1039 devc->analog_buffer = g_try_malloc(
1040 sizeof(float) * size / 2);
1041 }
1042 start_transfers(sdi);
1043 if ((ret = fx2lafw_command_start_acquisition(sdi)) != SR_OK) {
1044 fx2lafw_abort_acquisition(devc);
1045 return ret;
1046 }
1047 }
1048
1049 return SR_OK;
1050}
1051
1052static int dev_acquisition_stop(struct sr_dev_inst *sdi)
1053{
1054 struct dev_context *devc;
1055
1056 devc = sdi->priv;
1057
1058 if (devc->dslogic)
1059 dslogic_stop_acquisition(sdi);
1060
1061 fx2lafw_abort_acquisition(sdi->priv);
1062
1063 return SR_OK;
1064}
1065
1066static struct sr_dev_driver fx2lafw_driver_info = {
1067 .name = "fx2lafw",
1068 .longname = "fx2lafw (generic driver for FX2 based LAs)",
1069 .api_version = 1,
1070 .init = std_init,
1071 .cleanup = std_cleanup,
1072 .scan = scan,
1073 .dev_list = std_dev_list,
1074 .dev_clear = dev_clear,
1075 .config_get = config_get,
1076 .config_set = config_set,
1077 .config_list = config_list,
1078 .dev_open = dev_open,
1079 .dev_close = dev_close,
1080 .dev_acquisition_start = dev_acquisition_start,
1081 .dev_acquisition_stop = dev_acquisition_stop,
1082 .context = NULL,
1083};
1084SR_REGISTER_DEV_DRIVER(fx2lafw_driver_info);