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