]> sigrok.org Git - libsigrok.git/blob - src/hardware/fx2lafw/api.c
fx2lafw: Use wide_sampling only if necessary.
[libsigrok.git] / src / hardware / fx2lafw / api.c
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
26 static 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
127 static const uint32_t drvopts[] = {
128         SR_CONF_LOGIC_ANALYZER,
129 };
130
131 static const uint32_t scanopts[] = {
132         SR_CONF_CONN,
133 };
134
135 static 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
144 static 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
156 static 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. */
165 static const char *const signal_edge_names[] = {
166         [DS_EDGE_RISING] = "rising",
167         [DS_EDGE_FALLING] = "falling",
168 };
169
170 static 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
179 static 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
198 static 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
217 static 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
231 static 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_product ||
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                 sdi->priv = devc;
387                 devices = g_slist_append(devices, sdi);
388
389                 if (!strcmp(prof->model, "DSLogic")
390                                 || !strcmp(prof->model, "DSLogic Pro")
391                                 || !strcmp(prof->model, "DSCope")) {
392                         devc->dslogic = TRUE;
393                         devc->samplerates = dslogic_samplerates;
394                         devc->num_samplerates = ARRAY_SIZE(dslogic_samplerates);
395                         has_firmware = match_manuf_prod(devlist[i], "DreamSourceLab", "DSLogic")
396                                         || match_manuf_prod(devlist[i], "DreamSourceLab", "DSCope");
397                 } else {
398                         devc->dslogic = FALSE;
399                         devc->samplerates = samplerates;
400                         devc->num_samplerates = ARRAY_SIZE(samplerates);
401                         has_firmware = match_manuf_prod(devlist[i],
402                                         "sigrok", "fx2lafw");
403                 }
404
405                 if (has_firmware) {
406                         /* Already has the firmware, so fix the new address. */
407                         sr_dbg("Found an fx2lafw device.");
408                         sdi->status = SR_ST_INACTIVE;
409                         sdi->inst_type = SR_INST_USB;
410                         sdi->conn = sr_usb_dev_inst_new(libusb_get_bus_number(devlist[i]),
411                                         libusb_get_device_address(devlist[i]), NULL);
412                 } else {
413                         if (ezusb_upload_firmware(drvc->sr_ctx, devlist[i],
414                                         USB_CONFIGURATION, prof->firmware) == SR_OK)
415                                 /* Store when this device's FW was updated. */
416                                 devc->fw_updated = g_get_monotonic_time();
417                         else
418                                 sr_err("Firmware upload failed for "
419                                        "device %d.%d (logical).",
420                                        libusb_get_bus_number(devlist[i]),
421                                        libusb_get_device_address(devlist[i]));
422                         sdi->inst_type = SR_INST_USB;
423                         sdi->conn = sr_usb_dev_inst_new(libusb_get_bus_number(devlist[i]),
424                                         0xff, NULL);
425                 }
426         }
427         libusb_free_device_list(devlist, 1);
428         g_slist_free_full(conn_devices, (GDestroyNotify)sr_usb_dev_inst_free);
429
430         return std_scan_complete(di, devices);
431 }
432
433 static void clear_dev_context(void *priv)
434 {
435         struct dev_context *devc;
436
437         devc = priv;
438         g_slist_free(devc->enabled_analog_channels);
439         g_free(devc);
440 }
441
442 static int dev_clear(const struct sr_dev_driver *di)
443 {
444         return std_dev_clear(di, clear_dev_context);
445 }
446
447 static int dev_open(struct sr_dev_inst *sdi)
448 {
449         struct sr_dev_driver *di = sdi->driver;
450         struct sr_usb_dev_inst *usb;
451         struct dev_context *devc;
452         const char *fpga_firmware = NULL;
453         int ret;
454         int64_t timediff_us, timediff_ms;
455
456         devc = sdi->priv;
457         usb = sdi->conn;
458
459         /*
460          * If the firmware was recently uploaded, wait up to MAX_RENUM_DELAY_MS
461          * milliseconds for the FX2 to renumerate.
462          */
463         ret = SR_ERR;
464         if (devc->fw_updated > 0) {
465                 sr_info("Waiting for device to reset.");
466                 /* Takes >= 300ms for the FX2 to be gone from the USB bus. */
467                 g_usleep(300 * 1000);
468                 timediff_ms = 0;
469                 while (timediff_ms < MAX_RENUM_DELAY_MS) {
470                         if ((ret = fx2lafw_dev_open(sdi, di)) == SR_OK)
471                                 break;
472                         g_usleep(100 * 1000);
473
474                         timediff_us = g_get_monotonic_time() - devc->fw_updated;
475                         timediff_ms = timediff_us / 1000;
476                         sr_spew("Waited %" PRIi64 "ms.", timediff_ms);
477                 }
478                 if (ret != SR_OK) {
479                         sr_err("Device failed to renumerate.");
480                         return SR_ERR;
481                 }
482                 sr_info("Device came back after %" PRIi64 "ms.", timediff_ms);
483         } else {
484                 sr_info("Firmware upload was not needed.");
485                 ret = fx2lafw_dev_open(sdi, di);
486         }
487
488         if (ret != SR_OK) {
489                 sr_err("Unable to open device.");
490                 return SR_ERR;
491         }
492
493         ret = libusb_claim_interface(usb->devhdl, USB_INTERFACE);
494         if (ret != 0) {
495                 switch (ret) {
496                 case LIBUSB_ERROR_BUSY:
497                         sr_err("Unable to claim USB interface. Another "
498                                "program or driver has already claimed it.");
499                         break;
500                 case LIBUSB_ERROR_NO_DEVICE:
501                         sr_err("Device has been disconnected.");
502                         break;
503                 default:
504                         sr_err("Unable to claim interface: %s.",
505                                libusb_error_name(ret));
506                         break;
507                 }
508
509                 return SR_ERR;
510         }
511
512         if (devc->dslogic) {
513                 if (!strcmp(devc->profile->model, "DSLogic")) {
514                         if (devc->dslogic_voltage_threshold == DS_VOLTAGE_RANGE_18_33_V)
515                                 fpga_firmware = DSLOGIC_FPGA_FIRMWARE_3V3;
516                         else
517                                 fpga_firmware = DSLOGIC_FPGA_FIRMWARE_5V;
518                 } else if (!strcmp(devc->profile->model, "DSLogic Pro")){
519                         fpga_firmware = DSLOGIC_PRO_FPGA_FIRMWARE;
520                 } else if (!strcmp(devc->profile->model, "DSCope")) {
521                         fpga_firmware = DSCOPE_FPGA_FIRMWARE;
522                 }
523
524                 if ((ret = dslogic_fpga_firmware_upload(sdi, fpga_firmware)) != SR_OK)
525                         return ret;
526         }
527         if (devc->cur_samplerate == 0) {
528                 /* Samplerate hasn't been set; default to the slowest one. */
529                 devc->cur_samplerate = devc->samplerates[0];
530         }
531
532         return SR_OK;
533 }
534
535 static int dev_close(struct sr_dev_inst *sdi)
536 {
537         struct sr_usb_dev_inst *usb;
538
539         usb = sdi->conn;
540
541         if (!usb->devhdl)
542                 return SR_ERR;
543
544         sr_info("fx2lafw: Closing device on %d.%d (logical) / %s (physical) interface %d.",
545                 usb->bus, usb->address, sdi->connection_id, USB_INTERFACE);
546         libusb_release_interface(usb->devhdl, USB_INTERFACE);
547         libusb_close(usb->devhdl);
548         usb->devhdl = NULL;
549         sdi->status = SR_ST_INACTIVE;
550
551         return SR_OK;
552 }
553
554 static int config_get(uint32_t key, GVariant **data,
555         const struct sr_dev_inst *sdi, const struct sr_channel_group *cg)
556 {
557         struct dev_context *devc;
558         struct sr_usb_dev_inst *usb;
559         GVariant *range[2];
560         unsigned int i;
561         char str[128];
562
563         (void)cg;
564
565         if (!sdi)
566                 return SR_ERR_ARG;
567
568         devc = sdi->priv;
569
570         switch (key) {
571         case SR_CONF_CONN:
572                 if (!sdi->conn)
573                         return SR_ERR_ARG;
574                 usb = sdi->conn;
575                 if (usb->address == 255)
576                         /* Device still needs to re-enumerate after firmware
577                          * upload, so we don't know its (future) address. */
578                         return SR_ERR;
579                 snprintf(str, 128, "%d.%d", usb->bus, usb->address);
580                 *data = g_variant_new_string(str);
581                 break;
582         case SR_CONF_VOLTAGE_THRESHOLD:
583                 for (i = 0; i < ARRAY_SIZE(volt_thresholds); i++) {
584                         if (volt_thresholds[i].range != devc->dslogic_voltage_threshold)
585                                 continue;
586                         range[0] = g_variant_new_double(volt_thresholds[i].low);
587                         range[1] = g_variant_new_double(volt_thresholds[i].high);
588                         *data = g_variant_new_tuple(range, 2);
589                         break;
590                 }
591                 break;
592         case SR_CONF_LIMIT_SAMPLES:
593                 *data = g_variant_new_uint64(devc->limit_samples);
594                 break;
595         case SR_CONF_SAMPLERATE:
596                 *data = g_variant_new_uint64(devc->cur_samplerate);
597                 break;
598         case SR_CONF_CAPTURE_RATIO:
599                 *data = g_variant_new_uint64(devc->capture_ratio);
600                 break;
601         case SR_CONF_EXTERNAL_CLOCK:
602                 *data = g_variant_new_boolean(devc->dslogic_external_clock);
603                 break;
604         case SR_CONF_CONTINUOUS:
605                 *data = g_variant_new_boolean(devc->dslogic_continuous_mode);
606                 break;
607         case SR_CONF_CLOCK_EDGE:
608                 i = devc->dslogic_clock_edge;
609                 if (i >= ARRAY_SIZE(signal_edge_names))
610                         return SR_ERR_BUG;
611                 *data = g_variant_new_string(signal_edge_names[0]);
612                 break;
613         default:
614                 return SR_ERR_NA;
615         }
616
617         return SR_OK;
618 }
619
620 /*
621  * Helper for mapping a string-typed configuration value to an index
622  * within a table of possible values.
623  */
624 static int lookup_index(GVariant *value, const char *const *table, int len)
625 {
626         const char *entry;
627         int i;
628
629         entry = g_variant_get_string(value, NULL);
630         if (!entry)
631                 return -1;
632
633         /* Linear search is fine for very small tables. */
634         for (i = 0; i < len; i++) {
635                 if (strcmp(entry, table[i]) == 0)
636                         return i;
637         }
638
639         return -1;
640 }
641
642 static int config_set(uint32_t key, GVariant *data,
643         const struct sr_dev_inst *sdi, const struct sr_channel_group *cg)
644 {
645         struct dev_context *devc;
646         uint64_t arg;
647         int i, ret;
648         gdouble low, high;
649
650         (void)cg;
651
652         if (!sdi)
653                 return SR_ERR_ARG;
654
655         if (sdi->status != SR_ST_ACTIVE)
656                 return SR_ERR;
657
658         devc = sdi->priv;
659
660         ret = SR_OK;
661
662         switch (key) {
663         case SR_CONF_SAMPLERATE:
664                 arg = g_variant_get_uint64(data);
665                 for (i = 0; i < devc->num_samplerates; i++) {
666                         if (devc->samplerates[i] == arg) {
667                                 devc->cur_samplerate = arg;
668                                 break;
669                         }
670                 }
671                 if (i == devc->num_samplerates)
672                         ret = SR_ERR_ARG;
673                 break;
674         case SR_CONF_LIMIT_SAMPLES:
675                 devc->limit_samples = g_variant_get_uint64(data);
676                 break;
677         case SR_CONF_CAPTURE_RATIO:
678                 devc->capture_ratio = g_variant_get_uint64(data);
679                 ret = (devc->capture_ratio > 100) ? SR_ERR : SR_OK;
680                 break;
681         case SR_CONF_VOLTAGE_THRESHOLD:
682                 g_variant_get(data, "(dd)", &low, &high);
683                 ret = SR_ERR_ARG;
684                 for (i = 0; (unsigned int)i < ARRAY_SIZE(volt_thresholds); i++) {
685                         if (fabs(volt_thresholds[i].low - low) < 0.1 &&
686                             fabs(volt_thresholds[i].high - high) < 0.1) {
687                                 devc->dslogic_voltage_threshold = volt_thresholds[i].range;
688                                 break;
689                         }
690                 }
691                 if (!strcmp(devc->profile->model, "DSLogic")) {
692                         if (devc->dslogic_voltage_threshold == DS_VOLTAGE_RANGE_5_V)
693                                 ret = dslogic_fpga_firmware_upload(sdi, DSLOGIC_FPGA_FIRMWARE_5V);
694                         else
695                                 ret = dslogic_fpga_firmware_upload(sdi, DSLOGIC_FPGA_FIRMWARE_3V3);
696                 } else if (!strcmp(devc->profile->model, "DSLogic Pro")) {
697                         ret = dslogic_fpga_firmware_upload(sdi, DSLOGIC_PRO_FPGA_FIRMWARE);
698                 }
699                 break;
700         case SR_CONF_EXTERNAL_CLOCK:
701                 devc->dslogic_external_clock = g_variant_get_boolean(data);
702                 break;
703         case SR_CONF_CONTINUOUS:
704                 devc->dslogic_continuous_mode = g_variant_get_boolean(data);
705                 break;
706         case SR_CONF_CLOCK_EDGE:
707                 i = lookup_index(data, signal_edge_names,
708                                    ARRAY_SIZE(signal_edge_names));
709                 if (i < 0)
710                         return SR_ERR_ARG;
711                 devc->dslogic_clock_edge = i;
712                 break;          
713         default:
714                 ret = SR_ERR_NA;
715         }
716
717         return ret;
718 }
719
720 static int config_list(uint32_t key, GVariant **data,
721         const struct sr_dev_inst *sdi, const struct sr_channel_group *cg)
722 {
723         struct dev_context *devc;
724         GVariant *gvar, *range[2];
725         GVariantBuilder gvb;
726         unsigned int i;
727
728         (void)cg;
729
730         switch (key) {
731         case SR_CONF_SCAN_OPTIONS:
732                 *data = g_variant_new_fixed_array(G_VARIANT_TYPE_UINT32,
733                                 scanopts, ARRAY_SIZE(scanopts), sizeof(uint32_t));
734                 break;
735         case SR_CONF_DEVICE_OPTIONS:
736                 if (!sdi) {
737                         *data = g_variant_new_fixed_array(G_VARIANT_TYPE_UINT32,
738                                 drvopts, ARRAY_SIZE(drvopts), sizeof(uint32_t));
739                 } else {
740                         devc = sdi->priv;
741                         if (!devc->dslogic)
742                                 *data = g_variant_new_fixed_array(G_VARIANT_TYPE_UINT32,
743                                                                   devopts, ARRAY_SIZE(devopts), sizeof(uint32_t));
744                         else
745                                 *data = g_variant_new_fixed_array(G_VARIANT_TYPE_UINT32,
746                                                                   dslogic_devopts, ARRAY_SIZE(dslogic_devopts), sizeof(uint32_t));
747                 }
748                 break;
749         case SR_CONF_VOLTAGE_THRESHOLD:
750                 if (!sdi->priv)
751                         return SR_ERR_ARG;
752                 devc = sdi->priv;
753                 if (!devc->dslogic)
754                         return SR_ERR_NA;
755                 g_variant_builder_init(&gvb, G_VARIANT_TYPE_ARRAY);
756                 for (i = 0; i < ARRAY_SIZE(volt_thresholds); i++) {
757                         range[0] = g_variant_new_double(volt_thresholds[i].low);
758                         range[1] = g_variant_new_double(volt_thresholds[i].high);
759                         gvar = g_variant_new_tuple(range, 2);
760                         g_variant_builder_add_value(&gvb, gvar);
761                 }
762                 *data = g_variant_builder_end(&gvb);
763                 break;
764         case SR_CONF_SAMPLERATE:
765                 devc = sdi->priv;
766                 g_variant_builder_init(&gvb, G_VARIANT_TYPE("a{sv}"));
767                 gvar = g_variant_new_fixed_array(G_VARIANT_TYPE("t"), devc->samplerates,
768                                 devc->num_samplerates, sizeof(uint64_t));
769                 g_variant_builder_add(&gvb, "{sv}", "samplerates", gvar);
770                 *data = g_variant_builder_end(&gvb);
771                 break;
772         case SR_CONF_TRIGGER_MATCH:
773                 *data = g_variant_new_fixed_array(G_VARIANT_TYPE_INT32,
774                                 soft_trigger_matches, ARRAY_SIZE(soft_trigger_matches),
775                                 sizeof(int32_t));
776                 break;
777         case SR_CONF_CLOCK_EDGE:
778                 *data = g_variant_new_strv(signal_edge_names,
779                         ARRAY_SIZE(signal_edge_names));
780                 break;
781         default:
782                 return SR_ERR_NA;
783         }
784
785         return SR_OK;
786 }
787
788 static int receive_data(int fd, int revents, void *cb_data)
789 {
790         struct timeval tv;
791         struct drv_context *drvc;
792
793         (void)fd;
794         (void)revents;
795
796         drvc = (struct drv_context *)cb_data;
797
798         tv.tv_sec = tv.tv_usec = 0;
799         libusb_handle_events_timeout(drvc->sr_ctx->libusb_ctx, &tv);
800
801         return TRUE;
802 }
803
804 static int start_transfers(const struct sr_dev_inst *sdi)
805 {
806         struct dev_context *devc;
807         struct sr_usb_dev_inst *usb;
808         struct sr_trigger *trigger;
809         struct libusb_transfer *transfer;
810         unsigned int i, num_transfers;
811         int endpoint, timeout, ret;
812         unsigned char *buf;
813         size_t size;
814
815         devc = sdi->priv;
816         usb = sdi->conn;
817
818         devc->sent_samples = 0;
819         devc->acq_aborted = FALSE;
820         devc->empty_transfer_count = 0;
821
822         if ((trigger = sr_session_trigger_get(sdi->session)) && !devc->dslogic) {
823                 int pre_trigger_samples = 0;
824                 if (devc->limit_samples > 0)
825                         pre_trigger_samples = devc->capture_ratio * devc->limit_samples/100;
826                 devc->stl = soft_trigger_logic_new(sdi, trigger, pre_trigger_samples);
827                 if (!devc->stl)
828                         return SR_ERR_MALLOC;
829                 devc->trigger_fired = FALSE;
830         } else
831                 devc->trigger_fired = TRUE;
832
833         num_transfers = fx2lafw_get_number_of_transfers(devc);
834
835         //if (devc->dslogic)
836         //      num_transfers = dslogic_get_number_of_transfers(devc);
837
838         if (devc->dslogic) {
839                 if (devc->cur_samplerate == SR_MHZ(100))
840                         num_transfers = 16;
841                 else if (devc->cur_samplerate == SR_MHZ(200))
842                         num_transfers = 8;
843                 else if (devc->cur_samplerate == SR_MHZ(400))
844                         num_transfers = 4;
845         }
846
847         size = fx2lafw_get_buffer_size(devc);
848         devc->submitted_transfers = 0;
849
850         devc->transfers = g_try_malloc0(sizeof(*devc->transfers) * num_transfers);
851         if (!devc->transfers) {
852                 sr_err("USB transfers malloc failed.");
853                 return SR_ERR_MALLOC;
854         }
855
856         timeout = fx2lafw_get_timeout(devc);
857         endpoint = devc->dslogic ? 6 : 2;
858         devc->num_transfers = num_transfers;
859         for (i = 0; i < num_transfers; i++) {
860                 if (!(buf = g_try_malloc(size))) {
861                         sr_err("USB transfer buffer malloc failed.");
862                         return SR_ERR_MALLOC;
863                 }
864                 transfer = libusb_alloc_transfer(0);
865                 libusb_fill_bulk_transfer(transfer, usb->devhdl,
866                                 endpoint | LIBUSB_ENDPOINT_IN, buf, size,
867                                 fx2lafw_receive_transfer, (void *)sdi, timeout);
868                 sr_info("submitting transfer: %d", i);
869                 if ((ret = libusb_submit_transfer(transfer)) != 0) {
870                         sr_err("Failed to submit transfer: %s.",
871                                libusb_error_name(ret));
872                         libusb_free_transfer(transfer);
873                         g_free(buf);
874                         fx2lafw_abort_acquisition(devc);
875                         return SR_ERR;
876                 }
877                 devc->transfers[i] = transfer;
878                 devc->submitted_transfers++;
879         }
880
881         if (devc->profile->dev_caps & DEV_CAPS_AX_ANALOG)
882                 devc->send_data_proc = mso_send_data_proc;
883         else
884                 devc->send_data_proc = la_send_data_proc;
885
886         std_session_send_df_header(sdi);
887
888         return SR_OK;
889 }
890
891 static void LIBUSB_CALL dslogic_trigger_receive(struct libusb_transfer *transfer)
892 {
893         const struct sr_dev_inst *sdi;
894         struct dslogic_trigger_pos *tpos;
895         struct dev_context *devc;
896
897         sdi = transfer->user_data;
898         devc = sdi->priv;
899         if (transfer->status == LIBUSB_TRANSFER_CANCELLED) {
900                 sr_dbg("Trigger transfer canceled.");
901                 /* Terminate session. */
902                 std_session_send_df_end(sdi);
903                 usb_source_remove(sdi->session, devc->ctx);
904                 devc->num_transfers = 0;
905                 g_free(devc->transfers);
906                 if (devc->stl) {
907                         soft_trigger_logic_free(devc->stl);
908                         devc->stl = NULL;
909                 }
910         } else if (transfer->status == LIBUSB_TRANSFER_COMPLETED
911                         && transfer->actual_length == sizeof(struct dslogic_trigger_pos)) {
912                 tpos = (struct dslogic_trigger_pos *)transfer->buffer;
913                 sr_info("tpos real_pos %d ram_saddr %d cnt %d", tpos->real_pos,
914                         tpos->ram_saddr, tpos->remain_cnt);
915                 devc->trigger_pos = tpos->real_pos;
916                 g_free(tpos);
917                 start_transfers(sdi);
918         }
919         libusb_free_transfer(transfer);
920 }
921
922 static int dslogic_trigger_request(const struct sr_dev_inst *sdi)
923 {
924         struct sr_usb_dev_inst *usb;
925         struct libusb_transfer *transfer;
926         struct dslogic_trigger_pos *tpos;
927         struct dev_context *devc;
928         int ret;
929
930         usb = sdi->conn;
931         devc = sdi->priv;
932
933         if ((ret = dslogic_stop_acquisition(sdi)) != SR_OK)
934                 return ret;
935
936         if ((ret = dslogic_fpga_configure(sdi)) != SR_OK)
937                 return ret;
938
939         /* If this is a DSLogic Pro, set the voltage threshold. */
940         if (!strcmp(devc->profile->model, "DSLogic Pro")){
941                 if (devc->dslogic_voltage_threshold == DS_VOLTAGE_RANGE_18_33_V) {
942                         dslogic_set_vth(sdi, 1.4);
943                 } else {
944                         dslogic_set_vth(sdi, 3.3);
945                 }
946         }
947
948         if ((ret = dslogic_start_acquisition(sdi)) != SR_OK)
949                 return ret;
950
951         sr_dbg("Getting trigger.");
952         tpos = g_malloc(sizeof(struct dslogic_trigger_pos));
953         transfer = libusb_alloc_transfer(0);
954         libusb_fill_bulk_transfer(transfer, usb->devhdl, 6 | LIBUSB_ENDPOINT_IN,
955                         (unsigned char *)tpos, sizeof(struct dslogic_trigger_pos),
956                         dslogic_trigger_receive, (void *)sdi, 0);
957         if ((ret = libusb_submit_transfer(transfer)) < 0) {
958                 sr_err("Failed to request trigger: %s.", libusb_error_name(ret));
959                 libusb_free_transfer(transfer);
960                 g_free(tpos);
961                 return SR_ERR;
962         }
963
964         devc->transfers = g_try_malloc0(sizeof(*devc->transfers));
965         if (!devc->transfers) {
966                 sr_err("USB trigger_pos transfer malloc failed.");
967                 return SR_ERR_MALLOC;
968         }
969         devc->num_transfers = 1;
970         devc->submitted_transfers++;
971         devc->transfers[0] = transfer;
972
973         return ret;
974 }
975
976 static int configure_channels(const struct sr_dev_inst *sdi)
977 {
978         struct dev_context *devc;
979         const GSList *l;
980         int p;
981         struct sr_channel *ch;
982         uint32_t channel_mask = 0, num_analog = 0;
983
984         devc = sdi->priv;
985
986         g_slist_free(devc->enabled_analog_channels);
987         devc->enabled_analog_channels = NULL;
988         memset(devc->ch_enabled, 0, sizeof(devc->ch_enabled));
989
990         for (l = sdi->channels, p = 0; l; l = l->next, p++) {
991                 ch = l->data;
992                 if ((p <= NUM_CHANNELS) && (ch->type == SR_CHANNEL_ANALOG)) {
993                         num_analog++;
994                         devc->ch_enabled[p] = ch->enabled;
995                         devc->enabled_analog_channels =
996                             g_slist_append(devc->enabled_analog_channels, ch);
997                 } else {
998                         channel_mask |= ch->enabled << p;
999                 }
1000         }
1001
1002         /* Use no wide sampling if we have only the first 8 channels set. */
1003         devc->sample_wide = (channel_mask > 0xff || num_analog > 0);
1004
1005         return SR_OK;
1006 }
1007
1008 static int dev_acquisition_start(const struct sr_dev_inst *sdi)
1009 {
1010         struct sr_dev_driver *di;
1011         struct drv_context *drvc;
1012         struct dev_context *devc;
1013         int timeout, ret;
1014         size_t size;
1015
1016         if (sdi->status != SR_ST_ACTIVE)
1017                 return SR_ERR_DEV_CLOSED;
1018
1019         di = sdi->driver;
1020         drvc = di->context;
1021         devc = sdi->priv;
1022
1023         devc->ctx = drvc->sr_ctx;
1024         devc->sent_samples = 0;
1025         devc->empty_transfer_count = 0;
1026         devc->acq_aborted = FALSE;
1027
1028         if (configure_channels(sdi) != SR_OK) {
1029                 sr_err("Failed to configure channels.");
1030                 return SR_ERR;
1031         }
1032
1033         timeout = fx2lafw_get_timeout(devc);
1034         usb_source_add(sdi->session, devc->ctx, timeout, receive_data, drvc);
1035
1036         if (devc->dslogic) {
1037                 dslogic_trigger_request(sdi);
1038         } else {
1039                 size = fx2lafw_get_buffer_size(devc);
1040                 /* Prepare for analog sampling. */
1041                 if (devc->profile->dev_caps & DEV_CAPS_AX_ANALOG) {
1042                         /* We need a buffer half the size of a transfer. */
1043                         devc->logic_buffer = g_try_malloc(size / 2);
1044                         devc->analog_buffer = g_try_malloc(
1045                                 sizeof(float) * size / 2);
1046                 }
1047                 start_transfers(sdi);
1048                 if ((ret = fx2lafw_command_start_acquisition(sdi)) != SR_OK) {
1049                         fx2lafw_abort_acquisition(devc);
1050                         return ret;
1051                 }
1052         }
1053
1054         return SR_OK;
1055 }
1056
1057 static int dev_acquisition_stop(struct sr_dev_inst *sdi)
1058 {
1059         struct dev_context *devc;
1060
1061         devc = sdi->priv;
1062
1063         if (devc->dslogic)
1064                 dslogic_stop_acquisition(sdi);
1065
1066         fx2lafw_abort_acquisition(sdi->priv);
1067
1068         return SR_OK;
1069 }
1070
1071 static struct sr_dev_driver fx2lafw_driver_info = {
1072         .name = "fx2lafw",
1073         .longname = "fx2lafw (generic driver for FX2 based LAs)",
1074         .api_version = 1,
1075         .init = std_init,
1076         .cleanup = std_cleanup,
1077         .scan = scan,
1078         .dev_list = std_dev_list,
1079         .dev_clear = dev_clear,
1080         .config_get = config_get,
1081         .config_set = config_set,
1082         .config_list = config_list,
1083         .dev_open = dev_open,
1084         .dev_close = dev_close,
1085         .dev_acquisition_start = dev_acquisition_start,
1086         .dev_acquisition_stop = dev_acquisition_stop,
1087         .context = NULL,
1088 };
1089 SR_REGISTER_DEV_DRIVER(fx2lafw_driver_info);