]> sigrok.org Git - libsigrok.git/blob - src/hardware/fx2lafw/api.c
fx2lafw: Add analog sampling handler
[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
25 static const struct fx2lafw_profile supported_fx2[] = {
26         /*
27          * CWAV USBee AX
28          * EE Electronics ESLA201A
29          * ARMFLY AX-Pro
30          */
31         { 0x08a9, 0x0014, "CWAV", "USBee AX", NULL,
32                 "fx2lafw-cwav-usbeeax.fw",
33                 DEV_CAPS_AX_ANALOG, NULL, NULL},
34         /*
35          * CWAV USBee DX
36          * XZL-Studio DX
37          */
38         { 0x08a9, 0x0015, "CWAV", "USBee DX", NULL,
39                 "fx2lafw-cwav-usbeedx.fw",
40                 DEV_CAPS_16BIT, NULL, NULL },
41
42         /*
43          * CWAV USBee SX
44          */
45         { 0x08a9, 0x0009, "CWAV", "USBee SX", NULL,
46                 "fx2lafw-cwav-usbeesx.fw",
47                 0, NULL, NULL},
48
49         /* DreamSourceLab DSLogic (before FW upload) */
50         { 0x2a0e, 0x0001, "DreamSourceLab", "DSLogic", NULL,
51                 "dreamsourcelab-dslogic-fx2.fw",
52                 DEV_CAPS_16BIT, NULL, NULL},
53         /* DreamSourceLab DSLogic (after FW upload) */
54         { 0x2a0e, 0x0001, "DreamSourceLab", "DSLogic", NULL,
55                 "dreamsourcelab-dslogic-fx2.fw",
56                 DEV_CAPS_16BIT, "DreamSourceLab", "DSLogic"},
57
58         /* DreamSourceLab DSCope (before FW upload) */
59         { 0x2a0e, 0x0002, "DreamSourceLab", "DSCope", NULL,
60                 "dreamsourcelab-dscope-fx2.fw",
61                 DEV_CAPS_16BIT, NULL, NULL},
62         /* DreamSourceLab DSCope (after FW upload) */
63         { 0x2a0e, 0x0002, "DreamSourceLab", "DSCope", NULL,
64                 "dreamsourcelab-dscope-fx2.fw",
65                 DEV_CAPS_16BIT, "DreamSourceLab", "DSCope"},
66
67         /* DreamSourceLab DSLogic Pro (before FW upload) */
68         { 0x2a0e, 0x0003, "DreamSourceLab", "DSLogic Pro", NULL,
69                 "dreamsourcelab-dslogic-pro-fx2.fw",
70                 DEV_CAPS_16BIT, NULL, NULL},
71         /* DreamSourceLab DSLogic Pro (after FW upload) */
72         { 0x2a0e, 0x0003, "DreamSourceLab", "DSLogic Pro", NULL,
73                 "dreamsourcelab-dslogic-pro-fx2.fw",
74                 DEV_CAPS_16BIT, "DreamSourceLab", "DSLogic"},
75
76         /*
77          * Saleae Logic
78          * EE Electronics ESLA100
79          * Robomotic MiniLogic
80          * Robomotic BugLogic 3
81          */
82         { 0x0925, 0x3881, "Saleae", "Logic", NULL,
83                 "fx2lafw-saleae-logic.fw",
84                 0, NULL, NULL},
85
86         /*
87          * Default Cypress FX2 without EEPROM, e.g.:
88          * Lcsoft Mini Board
89          * Braintechnology USB Interface V2.x
90          */
91         { 0x04B4, 0x8613, "Cypress", "FX2", NULL,
92                 "fx2lafw-cypress-fx2.fw",
93                 DEV_CAPS_16BIT, NULL, NULL },
94
95         /*
96          * Braintechnology USB-LPS
97          */
98         { 0x16d0, 0x0498, "Braintechnology", "USB-LPS", NULL,
99                 "fx2lafw-braintechnology-usb-lps.fw",
100                 DEV_CAPS_16BIT, NULL, NULL },
101
102         /*
103          * sigrok FX2 based 8-channel logic analyzer
104          */
105         { 0x1d50, 0x608c, "sigrok", "FX2 LA (8ch)", NULL,
106                 "fx2lafw-sigrok-fx2-8ch.fw",
107                 0, NULL, NULL},
108
109         /*
110          * sigrok FX2 based 16-channel logic analyzer
111          */
112         { 0x1d50, 0x608d, "sigrok", "FX2 LA (16ch)", NULL,
113                 "fx2lafw-sigrok-fx2-16ch.fw",
114                 DEV_CAPS_16BIT, NULL, NULL },
115
116         ALL_ZERO
117 };
118
119 static const uint32_t drvopts[] = {
120         SR_CONF_LOGIC_ANALYZER,
121 };
122
123 static const uint32_t scanopts[] = {
124         SR_CONF_CONN,
125 };
126
127 static const uint32_t devopts[] = {
128         SR_CONF_CONTINUOUS | SR_CONF_SET,
129         SR_CONF_LIMIT_SAMPLES | SR_CONF_GET | SR_CONF_SET,
130         SR_CONF_CONN | SR_CONF_GET,
131         SR_CONF_SAMPLERATE | SR_CONF_GET | SR_CONF_SET | SR_CONF_LIST,
132         SR_CONF_TRIGGER_MATCH | SR_CONF_LIST,
133         SR_CONF_CAPTURE_RATIO | SR_CONF_GET | SR_CONF_SET,
134 };
135
136 static const char *channel_names[] = {
137         "0", "1", "2", "3", "4", "5", "6", "7",
138         "8", "9", "10", "11", "12", "13", "14", "15",
139 };
140
141 static const char *ax_channel_names[] = {
142         "A0",
143 };
144
145 static const int32_t soft_trigger_matches[] = {
146         SR_TRIGGER_ZERO,
147         SR_TRIGGER_ONE,
148         SR_TRIGGER_RISING,
149         SR_TRIGGER_FALLING,
150         SR_TRIGGER_EDGE,
151 };
152
153 static const uint64_t samplerates[] = {
154         SR_KHZ(20),
155         SR_KHZ(25),
156         SR_KHZ(50),
157         SR_KHZ(100),
158         SR_KHZ(200),
159         SR_KHZ(250),
160         SR_KHZ(500),
161         SR_MHZ(1),
162         SR_MHZ(2),
163         SR_MHZ(3),
164         SR_MHZ(4),
165         SR_MHZ(6),
166         SR_MHZ(8),
167         SR_MHZ(12),
168         SR_MHZ(16),
169         SR_MHZ(24),
170 };
171
172 static const uint64_t dslogic_samplerates[] = {
173         SR_KHZ(10),
174         SR_KHZ(20),
175         SR_KHZ(50),
176         SR_KHZ(100),
177         SR_KHZ(200),
178         SR_KHZ(500),
179         SR_MHZ(1),
180         SR_MHZ(2),
181         SR_MHZ(5),
182         SR_MHZ(10),
183         SR_MHZ(20),
184         SR_MHZ(25),
185         SR_MHZ(50),
186         SR_MHZ(100),
187         SR_MHZ(200),
188         SR_MHZ(400),
189 };
190
191 SR_PRIV struct sr_dev_driver fx2lafw_driver_info;
192
193 static int init(struct sr_dev_driver *di, struct sr_context *sr_ctx)
194 {
195         return std_init(sr_ctx, di, LOG_PREFIX);
196 }
197
198 static GSList *scan(struct sr_dev_driver *di, GSList *options)
199 {
200         struct drv_context *drvc;
201         struct dev_context *devc;
202         struct sr_dev_inst *sdi;
203         struct sr_usb_dev_inst *usb;
204         struct sr_config *src;
205         const struct fx2lafw_profile *prof;
206         GSList *l, *devices, *conn_devices;
207         gboolean has_firmware;
208         struct libusb_device_descriptor des;
209         libusb_device **devlist;
210         struct libusb_device_handle *hdl;
211         int ret, i, j;
212         int num_logic_channels = 0, num_analog_channels = 0;
213         const char *conn;
214         char manufacturer[64], product[64], serial_num[64], connection_id[64];
215
216         drvc = di->context;
217
218         conn = NULL;
219         for (l = options; l; l = l->next) {
220                 src = l->data;
221                 switch (src->key) {
222                 case SR_CONF_CONN:
223                         conn = g_variant_get_string(src->data, NULL);
224                         break;
225                 }
226         }
227         if (conn)
228                 conn_devices = sr_usb_find(drvc->sr_ctx->libusb_ctx, conn);
229         else
230                 conn_devices = NULL;
231
232         /* Find all fx2lafw compatible devices and upload firmware to them. */
233         devices = NULL;
234         libusb_get_device_list(drvc->sr_ctx->libusb_ctx, &devlist);
235         for (i = 0; devlist[i]; i++) {
236                 if (conn) {
237                         usb = NULL;
238                         for (l = conn_devices; l; l = l->next) {
239                                 usb = l->data;
240                                 if (usb->bus == libusb_get_bus_number(devlist[i])
241                                         && usb->address == libusb_get_device_address(devlist[i]))
242                                         break;
243                         }
244                         if (!l)
245                                 /* This device matched none of the ones that
246                                  * matched the conn specification. */
247                                 continue;
248                 }
249
250                 libusb_get_device_descriptor( devlist[i], &des);
251
252                 if ((ret = libusb_open(devlist[i], &hdl)) < 0)
253                         continue;
254
255                 if (des.iManufacturer == 0) {
256                         manufacturer[0] = '\0';
257                 } else if ((ret = libusb_get_string_descriptor_ascii(hdl,
258                                 des.iManufacturer, (unsigned char *) manufacturer,
259                                 sizeof(manufacturer))) < 0) {
260                         sr_warn("Failed to get manufacturer string descriptor: %s.",
261                                 libusb_error_name(ret));
262                         continue;
263                 }
264
265                 if (des.iProduct == 0) {
266                         product[0] = '\0';
267                 } else if ((ret = libusb_get_string_descriptor_ascii(hdl,
268                                 des.iProduct, (unsigned char *) product,
269                                 sizeof(product))) < 0) {
270                         sr_warn("Failed to get product string descriptor: %s.",
271                                 libusb_error_name(ret));
272                         continue;
273                 }
274
275                 if (des.iSerialNumber == 0) {
276                         serial_num[0] = '\0';
277                 } else if ((ret = libusb_get_string_descriptor_ascii(hdl,
278                                 des.iSerialNumber, (unsigned char *) serial_num,
279                                 sizeof(serial_num))) < 0) {
280                         sr_warn("Failed to get serial number string descriptor: %s.",
281                                 libusb_error_name(ret));
282                         continue;
283                 }
284
285                 usb_get_port_path(devlist[i], connection_id, sizeof(connection_id));
286
287                 libusb_close(hdl);
288
289                 prof = NULL;
290                 for (j = 0; supported_fx2[j].vid; j++) {
291                         if (des.idVendor == supported_fx2[j].vid &&
292                                         des.idProduct == supported_fx2[j].pid &&
293                                         (!supported_fx2[j].usb_manufacturer ||
294                                          !strcmp(manufacturer, supported_fx2[j].usb_manufacturer)) &&
295                                         (!supported_fx2[j].usb_manufacturer ||
296                                          !strcmp(product, supported_fx2[j].usb_product))) {
297                                 prof = &supported_fx2[j];
298                                 break;
299                         }
300                 }
301
302                 /* Skip if the device was not found. */
303                 if (!prof)
304                         continue;
305
306                 sdi = g_malloc0(sizeof(struct sr_dev_inst));
307                 sdi->status = SR_ST_INITIALIZING;
308                 sdi->vendor = g_strdup(prof->vendor);
309                 sdi->model = g_strdup(prof->model);
310                 sdi->version = g_strdup(prof->model_version);
311                 sdi->driver = di;
312                 sdi->serial_num = g_strdup(serial_num);
313                 sdi->connection_id = g_strdup(connection_id);
314
315                 /* Fill in channellist according to this device's profile. */
316                 num_logic_channels = prof->dev_caps & DEV_CAPS_16BIT ? 16 : 8;
317                 num_analog_channels = prof->dev_caps & DEV_CAPS_AX_ANALOG ? 1 : 0;
318
319                 for (j = 0; j < num_logic_channels; j++)
320                         sr_channel_new(sdi, j, SR_CHANNEL_LOGIC, TRUE,
321                                         channel_names[j]);
322
323                 for (j = 0; j < num_analog_channels; j++)
324                         sr_channel_new(sdi, j, SR_CHANNEL_ANALOG, TRUE,
325                                         ax_channel_names[j]);
326
327                 devc = fx2lafw_dev_new();
328                 devc->profile = prof;
329                 devc->sample_wide = (prof->dev_caps & DEV_CAPS_16BIT) != 0;
330                 sdi->priv = devc;
331                 drvc->instances = g_slist_append(drvc->instances, sdi);
332                 devices = g_slist_append(devices, sdi);
333
334                 if (!strcmp(prof->model, "DSLogic")
335                                 || !strcmp(prof->model, "DSLogic Pro")
336                                 || !strcmp(prof->model, "DSCope")) {
337                         devc->dslogic = TRUE;
338                         devc->samplerates = dslogic_samplerates;
339                         devc->num_samplerates = ARRAY_SIZE(dslogic_samplerates);
340                         has_firmware = match_manuf_prod(devlist[i], "DreamSourceLab", "DSLogic")
341                                         || match_manuf_prod(devlist[i], "DreamSourceLab", "DSCope");
342                 } else {
343                         devc->dslogic = FALSE;
344                         devc->samplerates = samplerates;
345                         devc->num_samplerates = ARRAY_SIZE(samplerates);
346                         has_firmware = match_manuf_prod(devlist[i],
347                                         "sigrok", "fx2lafw");
348                 }
349
350                 if (has_firmware) {
351                         /* Already has the firmware, so fix the new address. */
352                         sr_dbg("Found an fx2lafw device.");
353                         sdi->status = SR_ST_INACTIVE;
354                         sdi->inst_type = SR_INST_USB;
355                         sdi->conn = sr_usb_dev_inst_new(libusb_get_bus_number(devlist[i]),
356                                         libusb_get_device_address(devlist[i]), NULL);
357                 } else {
358                         if (ezusb_upload_firmware(drvc->sr_ctx, devlist[i],
359                                         USB_CONFIGURATION, prof->firmware) == SR_OK)
360                                 /* Store when this device's FW was updated. */
361                                 devc->fw_updated = g_get_monotonic_time();
362                         else
363                                 sr_err("Firmware upload failed for "
364                                        "device %d.%d (logical).",
365                                        libusb_get_bus_number(devlist[i]),
366                                        libusb_get_device_address(devlist[i]));
367                         sdi->inst_type = SR_INST_USB;
368                         sdi->conn = sr_usb_dev_inst_new(libusb_get_bus_number(devlist[i]),
369                                         0xff, NULL);
370                 }
371         }
372         libusb_free_device_list(devlist, 1);
373         g_slist_free_full(conn_devices, (GDestroyNotify)sr_usb_dev_inst_free);
374
375         return devices;
376 }
377
378 static GSList *dev_list(const struct sr_dev_driver *di)
379 {
380         return ((struct drv_context *)(di->context))->instances;
381 }
382
383 static int dev_open(struct sr_dev_inst *sdi)
384 {
385         struct sr_dev_driver *di = sdi->driver;
386         struct sr_usb_dev_inst *usb;
387         struct dev_context *devc;
388         const char *fpga_firmware = NULL;
389         int ret;
390         int64_t timediff_us, timediff_ms;
391
392         devc = sdi->priv;
393         usb = sdi->conn;
394
395         /*
396          * If the firmware was recently uploaded, wait up to MAX_RENUM_DELAY_MS
397          * milliseconds for the FX2 to renumerate.
398          */
399         ret = SR_ERR;
400         if (devc->fw_updated > 0) {
401                 sr_info("Waiting for device to reset.");
402                 /* Takes >= 300ms for the FX2 to be gone from the USB bus. */
403                 g_usleep(300 * 1000);
404                 timediff_ms = 0;
405                 while (timediff_ms < MAX_RENUM_DELAY_MS) {
406                         if ((ret = fx2lafw_dev_open(sdi, di)) == SR_OK)
407                                 break;
408                         g_usleep(100 * 1000);
409
410                         timediff_us = g_get_monotonic_time() - devc->fw_updated;
411                         timediff_ms = timediff_us / 1000;
412                         sr_spew("Waited %" PRIi64 "ms.", timediff_ms);
413                 }
414                 if (ret != SR_OK) {
415                         sr_err("Device failed to renumerate.");
416                         return SR_ERR;
417                 }
418                 sr_info("Device came back after %" PRIi64 "ms.", timediff_ms);
419         } else {
420                 sr_info("Firmware upload was not needed.");
421                 ret = fx2lafw_dev_open(sdi, di);
422         }
423
424         if (ret != SR_OK) {
425                 sr_err("Unable to open device.");
426                 return SR_ERR;
427         }
428
429         ret = libusb_claim_interface(usb->devhdl, USB_INTERFACE);
430         if (ret != 0) {
431                 switch (ret) {
432                 case LIBUSB_ERROR_BUSY:
433                         sr_err("Unable to claim USB interface. Another "
434                                "program or driver has already claimed it.");
435                         break;
436                 case LIBUSB_ERROR_NO_DEVICE:
437                         sr_err("Device has been disconnected.");
438                         break;
439                 default:
440                         sr_err("Unable to claim interface: %s.",
441                                libusb_error_name(ret));
442                         break;
443                 }
444
445                 return SR_ERR;
446         }
447
448         if (devc->dslogic) {
449                 if (!strcmp(devc->profile->model, "DSLogic")) {
450                         fpga_firmware = DSLOGIC_FPGA_FIRMWARE;
451                 } else if (!strcmp(devc->profile->model, "DSLogic Pro")) {
452                         fpga_firmware = DSLOGIC_PRO_FPGA_FIRMWARE;
453                 } else if (!strcmp(devc->profile->model, "DSCope")) {
454                         fpga_firmware = DSCOPE_FPGA_FIRMWARE;
455                 }
456
457                 if ((ret = dslogic_fpga_firmware_upload(sdi,
458                                 fpga_firmware)) != SR_OK)
459                         return ret;
460         }
461
462         if (devc->cur_samplerate == 0) {
463                 /* Samplerate hasn't been set; default to the slowest one. */
464                 devc->cur_samplerate = devc->samplerates[0];
465         }
466
467         return SR_OK;
468 }
469
470 static int dev_close(struct sr_dev_inst *sdi)
471 {
472         struct sr_usb_dev_inst *usb;
473
474         usb = sdi->conn;
475         if (!usb->devhdl)
476                 return SR_ERR;
477
478         sr_info("fx2lafw: Closing device on %d.%d (logical) / %s (physical) interface %d.",
479                 usb->bus, usb->address, sdi->connection_id, USB_INTERFACE);
480         libusb_release_interface(usb->devhdl, USB_INTERFACE);
481         libusb_close(usb->devhdl);
482         usb->devhdl = NULL;
483         sdi->status = SR_ST_INACTIVE;
484
485         return SR_OK;
486 }
487
488 static int cleanup(const struct sr_dev_driver *di)
489 {
490         int ret;
491         struct drv_context *drvc;
492
493         if (!(drvc = di->context))
494                 return SR_OK;
495
496         ret = std_dev_clear(di, NULL);
497
498         g_free(drvc);
499
500         return ret;
501 }
502
503 static int config_get(uint32_t key, GVariant **data, const struct sr_dev_inst *sdi,
504                 const struct sr_channel_group *cg)
505 {
506         struct dev_context *devc;
507         struct sr_usb_dev_inst *usb;
508         char str[128];
509
510         (void)cg;
511
512         if (!sdi)
513                 return SR_ERR_ARG;
514
515         devc = sdi->priv;
516
517         switch (key) {
518         case SR_CONF_CONN:
519                 if (!sdi->conn)
520                         return SR_ERR_ARG;
521                 usb = sdi->conn;
522                 if (usb->address == 255)
523                         /* Device still needs to re-enumerate after firmware
524                          * upload, so we don't know its (future) address. */
525                         return SR_ERR;
526                 snprintf(str, 128, "%d.%d", usb->bus, usb->address);
527                 *data = g_variant_new_string(str);
528                 break;
529         case SR_CONF_LIMIT_SAMPLES:
530                 *data = g_variant_new_uint64(devc->limit_samples);
531                 break;
532         case SR_CONF_SAMPLERATE:
533                 *data = g_variant_new_uint64(devc->cur_samplerate);
534                 break;
535         case SR_CONF_CAPTURE_RATIO:
536                 *data = g_variant_new_uint64(devc->capture_ratio);
537                 break;
538         default:
539                 return SR_ERR_NA;
540         }
541
542         return SR_OK;
543 }
544
545 static int config_set(uint32_t key, GVariant *data, const struct sr_dev_inst *sdi,
546                 const struct sr_channel_group *cg)
547 {
548         struct dev_context *devc;
549         uint64_t arg;
550         int i, ret;
551
552         (void)cg;
553
554         if (!sdi)
555                 return SR_ERR_ARG;
556
557         if (sdi->status != SR_ST_ACTIVE)
558                 return SR_ERR;
559
560         devc = sdi->priv;
561
562         ret = SR_OK;
563
564         switch (key) {
565         case SR_CONF_SAMPLERATE:
566                 arg = g_variant_get_uint64(data);
567                 for (i = 0; i < devc->num_samplerates; i++) {
568                         if (devc->samplerates[i] == arg) {
569                                 devc->cur_samplerate = arg;
570                                 break;
571                         }
572                 }
573                 if (i == devc->num_samplerates)
574                         ret = SR_ERR_ARG;
575                 break;
576         case SR_CONF_LIMIT_SAMPLES:
577                 devc->limit_samples = g_variant_get_uint64(data);
578                 break;
579         case SR_CONF_CAPTURE_RATIO:
580                 devc->capture_ratio = g_variant_get_uint64(data);
581                 ret = (devc->capture_ratio > 100) ? SR_ERR : SR_OK;
582                 break;
583         default:
584                 ret = SR_ERR_NA;
585         }
586
587         return ret;
588 }
589
590 static int config_list(uint32_t key, GVariant **data, const struct sr_dev_inst *sdi,
591                 const struct sr_channel_group *cg)
592 {
593         struct dev_context *devc;
594         GVariant *gvar;
595         GVariantBuilder gvb;
596
597         (void)cg;
598
599         switch (key) {
600         case SR_CONF_SCAN_OPTIONS:
601                 *data = g_variant_new_fixed_array(G_VARIANT_TYPE_UINT32,
602                                 scanopts, ARRAY_SIZE(scanopts), sizeof(uint32_t));
603                 break;
604         case SR_CONF_DEVICE_OPTIONS:
605                 if (!sdi)
606                         *data = g_variant_new_fixed_array(G_VARIANT_TYPE_UINT32,
607                                         drvopts, ARRAY_SIZE(drvopts), sizeof(uint32_t));
608                 else
609                         *data = g_variant_new_fixed_array(G_VARIANT_TYPE_UINT32,
610                                         devopts, ARRAY_SIZE(devopts), sizeof(uint32_t));
611                 break;
612         case SR_CONF_SAMPLERATE:
613                 if (!sdi->priv)
614                         return SR_ERR_ARG;
615                 devc = sdi->priv;
616                 g_variant_builder_init(&gvb, G_VARIANT_TYPE("a{sv}"));
617                 gvar = g_variant_new_fixed_array(G_VARIANT_TYPE("t"), devc->samplerates,
618                                 devc->num_samplerates, sizeof(uint64_t));
619                 g_variant_builder_add(&gvb, "{sv}", "samplerates", gvar);
620                 *data = g_variant_builder_end(&gvb);
621                 break;
622         case SR_CONF_TRIGGER_MATCH:
623                 *data = g_variant_new_fixed_array(G_VARIANT_TYPE_INT32,
624                                 soft_trigger_matches, ARRAY_SIZE(soft_trigger_matches),
625                                 sizeof(int32_t));
626                 break;
627         default:
628                 return SR_ERR_NA;
629         }
630
631         return SR_OK;
632 }
633
634 static int receive_data(int fd, int revents, void *cb_data)
635 {
636         struct timeval tv;
637         struct drv_context *drvc;
638
639         (void)fd;
640         (void)revents;
641
642         drvc = (struct drv_context *)cb_data;
643
644         tv.tv_sec = tv.tv_usec = 0;
645         libusb_handle_events_timeout(drvc->sr_ctx->libusb_ctx, &tv);
646
647         return TRUE;
648 }
649
650 static int start_transfers(const struct sr_dev_inst *sdi)
651 {
652         struct dev_context *devc;
653         struct sr_usb_dev_inst *usb;
654         struct sr_trigger *trigger;
655         struct libusb_transfer *transfer;
656         unsigned int i, num_transfers;
657         int endpoint, timeout, ret;
658         unsigned char *buf;
659         size_t size;
660
661         devc = sdi->priv;
662         usb = sdi->conn;
663
664         devc->sent_samples = 0;
665         devc->acq_aborted = FALSE;
666         devc->empty_transfer_count = 0;
667
668         if ((trigger = sr_session_trigger_get(sdi->session))) {
669                 int pre_trigger_samples = 0;
670                 if (devc->limit_samples > 0)
671                         pre_trigger_samples = devc->capture_ratio * devc->limit_samples/100;
672                 devc->stl = soft_trigger_logic_new(sdi, trigger, pre_trigger_samples);
673                 if (!devc->stl)
674                         return SR_ERR_MALLOC;
675                 devc->trigger_fired = FALSE;
676         } else
677                 devc->trigger_fired = TRUE;
678
679         num_transfers = fx2lafw_get_number_of_transfers(devc);
680         size = fx2lafw_get_buffer_size(devc);
681         devc->submitted_transfers = 0;
682
683         devc->transfers = g_try_malloc0(sizeof(*devc->transfers) * num_transfers);
684         if (!devc->transfers) {
685                 sr_err("USB transfers malloc failed.");
686                 return SR_ERR_MALLOC;
687         }
688
689         timeout = fx2lafw_get_timeout(devc);
690         endpoint = devc->dslogic ? 6 : 2;
691         devc->num_transfers = num_transfers;
692         for (i = 0; i < num_transfers; i++) {
693                 if (!(buf = g_try_malloc(size))) {
694                         sr_err("USB transfer buffer malloc failed.");
695                         return SR_ERR_MALLOC;
696                 }
697                 transfer = libusb_alloc_transfer(0);
698                 libusb_fill_bulk_transfer(transfer, usb->devhdl,
699                                 endpoint | LIBUSB_ENDPOINT_IN, buf, size,
700                                 fx2lafw_receive_transfer, (void *)sdi, timeout);
701                 if ((ret = libusb_submit_transfer(transfer)) != 0) {
702                         sr_err("Failed to submit transfer: %s.",
703                                libusb_error_name(ret));
704                         libusb_free_transfer(transfer);
705                         g_free(buf);
706                         fx2lafw_abort_acquisition(devc);
707                         return SR_ERR;
708                 }
709                 devc->transfers[i] = transfer;
710                 devc->submitted_transfers++;
711         }
712
713         if (devc->profile->dev_caps & DEV_CAPS_AX_ANALOG)
714                 devc->send_data_proc = mso_send_data_proc;
715         else
716                 devc->send_data_proc = la_send_data_proc;
717
718         /* Send header packet to the session bus. */
719         std_session_send_df_header(sdi, LOG_PREFIX);
720
721         return SR_OK;
722 }
723
724 static void LIBUSB_CALL dslogic_trigger_receive(struct libusb_transfer *transfer)
725 {
726         const struct sr_dev_inst *sdi;
727         struct sr_datafeed_packet packet;
728         struct dslogic_trigger_pos *tpos;
729         struct dev_context *devc;
730
731         sdi = transfer->user_data;
732         devc = sdi->priv;
733         if (transfer->status == LIBUSB_TRANSFER_CANCELLED) {
734                 sr_dbg("Trigger transfer canceled.");
735                 /* Terminate session. */
736                 packet.type = SR_DF_END;
737                 sr_session_send(sdi, &packet);
738                 usb_source_remove(sdi->session, devc->ctx);
739                 devc->num_transfers = 0;
740                 g_free(devc->transfers);
741                 if (devc->stl) {
742                         soft_trigger_logic_free(devc->stl);
743                         devc->stl = NULL;
744                 }
745         } else if (transfer->status == LIBUSB_TRANSFER_COMPLETED
746                         && transfer->actual_length == sizeof(struct dslogic_trigger_pos)) {
747                 tpos = (struct dslogic_trigger_pos *)transfer->buffer;
748                 sr_dbg("tpos real_pos %.8x ram_saddr %.8x", tpos->real_pos, tpos->ram_saddr);
749                 g_free(tpos);
750                 start_transfers(sdi);
751         }
752
753         libusb_free_transfer(transfer);
754
755 }
756
757 static int dslogic_trigger_request(const struct sr_dev_inst *sdi)
758 {
759         struct sr_usb_dev_inst *usb;
760         struct libusb_transfer *transfer;
761         struct dslogic_trigger_pos *tpos;
762         struct dev_context *devc;
763         int ret;
764
765         usb = sdi->conn;
766         devc = sdi->priv;
767
768         if ((ret = dslogic_stop_acquisition(sdi)) != SR_OK)
769                 return ret;
770
771         if ((ret = dslogic_fpga_configure(sdi)) != SR_OK)
772                 return ret;
773
774         if ((ret = dslogic_start_acquisition(sdi)) != SR_OK)
775                 return ret;
776
777         sr_dbg("Getting trigger.");
778         tpos = g_malloc(sizeof(struct dslogic_trigger_pos));
779         transfer = libusb_alloc_transfer(0);
780         libusb_fill_bulk_transfer(transfer, usb->devhdl, 6 | LIBUSB_ENDPOINT_IN,
781                         (unsigned char *)tpos, sizeof(struct dslogic_trigger_pos),
782                         dslogic_trigger_receive, (void *)sdi, 0);
783         if ((ret = libusb_submit_transfer(transfer)) < 0) {
784                 sr_err("Failed to request trigger: %s.", libusb_error_name(ret));
785                 libusb_free_transfer(transfer);
786                 g_free(tpos);
787                 return SR_ERR;
788         }
789
790         devc->transfers = g_try_malloc0(sizeof(*devc->transfers));
791         if (!devc->transfers) {
792                 sr_err("USB trigger_pos transfer malloc failed.");
793                 return SR_ERR_MALLOC;
794         }
795         devc->num_transfers = 1;
796         devc->submitted_transfers++;
797         devc->transfers[0] = transfer;
798
799         return ret;
800 }
801
802 static int dev_acquisition_start(const struct sr_dev_inst *sdi, void *cb_data)
803 {
804         struct sr_dev_driver *di;
805         struct drv_context *drvc;
806         struct dev_context *devc;
807         int timeout, ret;
808         size_t size;
809
810         if (sdi->status != SR_ST_ACTIVE)
811                 return SR_ERR_DEV_CLOSED;
812
813         di = sdi->driver;
814         drvc = di->context;
815         devc = sdi->priv;
816
817         devc->ctx = drvc->sr_ctx;
818         devc->cb_data = cb_data;
819         devc->sent_samples = 0;
820         devc->empty_transfer_count = 0;
821         devc->acq_aborted = FALSE;
822
823         timeout = fx2lafw_get_timeout(devc);
824         usb_source_add(sdi->session, devc->ctx, timeout, receive_data, drvc);
825
826         if (devc->dslogic) {
827                 dslogic_trigger_request(sdi);
828         } else {
829                 size = fx2lafw_get_buffer_size(devc);
830                 /* Prepare for analog sampling. */
831                 if (devc->profile->dev_caps & DEV_CAPS_AX_ANALOG) {
832                         /* We need a buffer half the size of a transfer. */
833                         devc->logic_buffer = g_try_malloc(size / 2);
834                         devc->analog_buffer = g_try_malloc(
835                                 sizeof(float) * size / 2);
836                 }
837                 start_transfers(sdi);
838                 if ((ret = fx2lafw_command_start_acquisition(sdi)) != SR_OK) {
839                         fx2lafw_abort_acquisition(devc);
840                         return ret;
841                 }
842         }
843
844         return SR_OK;
845 }
846
847 static int dev_acquisition_stop(struct sr_dev_inst *sdi, void *cb_data)
848 {
849         struct dev_context *devc;
850
851         (void)cb_data;
852
853         devc = sdi->priv;
854
855         if (devc->dslogic)
856                 dslogic_stop_acquisition(sdi);
857
858         fx2lafw_abort_acquisition(sdi->priv);
859
860         return SR_OK;
861 }
862
863 SR_PRIV struct sr_dev_driver fx2lafw_driver_info = {
864         .name = "fx2lafw",
865         .longname = "fx2lafw (generic driver for FX2 based LAs)",
866         .api_version = 1,
867         .init = init,
868         .cleanup = cleanup,
869         .scan = scan,
870         .dev_list = dev_list,
871         .dev_clear = NULL,
872         .config_get = config_get,
873         .config_set = config_set,
874         .config_list = config_list,
875         .dev_open = dev_open,
876         .dev_close = dev_close,
877         .dev_acquisition_start = dev_acquisition_start,
878         .dev_acquisition_stop = dev_acquisition_stop,
879         .context = NULL,
880 };