]> sigrok.org Git - libsigrok.git/blame_incremental - hardware/fx2lafw/fx2lafw.c
projects / libsigrok.git / blame_incremental
? search:
summary | shortlog | log | commit | commitdiff | tree
blob | blame (non-incremental) | history | HEAD
fx2lafw: Fix int64_t printing.
[libsigrok.git] / hardware / fx2lafw / fx2lafw.c
... / ...
CommitLineData
1/*
2 * This file is part of the sigrok project.
3 *
4 * Copyright (C) 2010-2012 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 <stdio.h>
22#include <stdlib.h>
23#include <string.h>
24#include <inttypes.h>
25#include <libusb.h>
26#include "libsigrok.h"
27#include "libsigrok-internal.h"
28#include "fx2lafw.h"
29#include "command.h"
30
31static const struct fx2lafw_profile supported_fx2[] = {
32 /*
33 * CWAV USBee AX
34 * EE Electronics ESLA201A
35 * ARMFLY AX-Pro
36 */
37 { 0x08a9, 0x0014, "CWAV", "USBee AX", NULL,
38 FIRMWARE_DIR "/fx2lafw-cwav-usbeeax.fw",
39 0 },
40 /*
41 * CWAV USBee DX
42 * XZL-Studio DX
43 */
44 { 0x08a9, 0x0015, "CWAV", "USBee DX", NULL,
45 FIRMWARE_DIR "/fx2lafw-cwav-usbeedx.fw",
46 DEV_CAPS_16BIT },
47
48 /*
49 * CWAV USBee SX
50 */
51 { 0x08a9, 0x0009, "CWAV", "USBee SX", NULL,
52 FIRMWARE_DIR "/fx2lafw-cwav-usbeesx.fw",
53 0 },
54
55 /*
56 * Saleae Logic
57 * EE Electronics ESLA100
58 * Robomotic MiniLogic
59 * Robomotic BugLogic 3
60 */
61 { 0x0925, 0x3881, "Saleae", "Logic", NULL,
62 FIRMWARE_DIR "/fx2lafw-saleae-logic.fw",
63 0 },
64
65 /*
66 * Default Cypress FX2 without EEPROM, e.g.:
67 * Lcsoft Mini Board
68 * Braintechnology USB Interface V2.x
69 */
70 { 0x04B4, 0x8613, "Cypress", "FX2", NULL,
71 FIRMWARE_DIR "/fx2lafw-cypress-fx2.fw",
72 DEV_CAPS_16BIT },
73
74 /*
75 * Braintechnology USB-LPS
76 */
77 { 0x16d0, 0x0498, "Braintechnology", "USB-LPS", NULL,
78 FIRMWARE_DIR "/fx2lafw-braintechnology-usb-lps.fw",
79 DEV_CAPS_16BIT },
80
81 { 0, 0, 0, 0, 0, 0, 0 }
82};
83
84static const int hwcaps[] = {
85 SR_HWCAP_LOGIC_ANALYZER,
86 SR_HWCAP_SAMPLERATE,
87
88 /* These are really implemented in the driver, not the hardware. */
89 SR_HWCAP_LIMIT_SAMPLES,
90 SR_HWCAP_CONTINUOUS,
91 0,
92};
93
94static const char *probe_names[] = {
95 "0",
96 "1",
97 "2",
98 "3",
99 "4",
100 "5",
101 "6",
102 "7",
103 "8",
104 "9",
105 "10",
106 "11",
107 "12",
108 "13",
109 "14",
110 "15",
111 NULL,
112};
113
114static const uint64_t supported_samplerates[] = {
115 SR_KHZ(20),
116 SR_KHZ(25),
117 SR_KHZ(50),
118 SR_KHZ(100),
119 SR_KHZ(200),
120 SR_KHZ(250),
121 SR_KHZ(500),
122 SR_MHZ(1),
123 SR_MHZ(2),
124 SR_MHZ(3),
125 SR_MHZ(4),
126 SR_MHZ(6),
127 SR_MHZ(8),
128 SR_MHZ(12),
129 SR_MHZ(16),
130 SR_MHZ(24),
131 0,
132};
133
134static const struct sr_samplerates samplerates = {
135 0,
136 0,
137 0,
138 supported_samplerates,
139};
140
141SR_PRIV struct sr_dev_driver fx2lafw_driver_info;
142static struct sr_dev_driver *di = &fx2lafw_driver_info;
143static int hw_dev_close(struct sr_dev_inst *sdi);
144static int hw_dev_config_set(const struct sr_dev_inst *sdi, int hwcap,
145 const void *value);
146static int hw_dev_acquisition_stop(struct sr_dev_inst *sdi, void *cb_data);
147
148/**
149 * Check the USB configuration to determine if this is an fx2lafw device.
150 *
151 * @return TRUE if the device's configuration profile match fx2lafw
152 * configuration, FALSE otherwise.
153 */
154static gboolean check_conf_profile(libusb_device *dev)
155{
156 struct libusb_device_descriptor des;
157 struct libusb_device_handle *hdl;
158 gboolean ret;
159 unsigned char strdesc[64];
160
161 hdl = NULL;
162 ret = FALSE;
163 while (!ret) {
164 /* Assume the FW has not been loaded, unless proven wrong. */
165 if (libusb_get_device_descriptor(dev, &des) != 0)
166 break;
167
168 if (libusb_open(dev, &hdl) != 0)
169 break;
170
171 if (libusb_get_string_descriptor_ascii(hdl,
172 des.iManufacturer, strdesc, sizeof(strdesc)) < 0)
173 break;
174 if (strncmp((const char *)strdesc, "sigrok", 6))
175 break;
176
177 if (libusb_get_string_descriptor_ascii(hdl,
178 des.iProduct, strdesc, sizeof(strdesc)) < 0)
179 break;
180 if (strncmp((const char *)strdesc, "fx2lafw", 7))
181 break;
182
183 /* If we made it here, it must be an fx2lafw. */
184 ret = TRUE;
185 }
186 if (hdl)
187 libusb_close(hdl);
188
189 return ret;
190}
191
192static int fx2lafw_dev_open(struct sr_dev_inst *sdi)
193{
194 libusb_device **devlist;
195 struct libusb_device_descriptor des;
196 struct dev_context *devc;
197 struct drv_context *drvc;
198 struct version_info vi;
199 int ret, skip, i, device_count;
200 uint8_t revid;
201
202 drvc = di->priv;
203 devc = sdi->priv;
204
205 if (sdi->status == SR_ST_ACTIVE)
206 /* Device is already in use. */
207 return SR_ERR;
208
209 skip = 0;
210 device_count = libusb_get_device_list(drvc->sr_ctx->libusb_ctx, &devlist);
211 if (device_count < 0) {
212 sr_err("Failed to get device list: %s.",
213 libusb_error_name(device_count));
214 return SR_ERR;
215 }
216
217 for (i = 0; i < device_count; i++) {
218 if ((ret = libusb_get_device_descriptor(devlist[i], &des))) {
219 sr_err("Failed to get device descriptor: %s.",
220 libusb_error_name(ret));
221 continue;
222 }
223
224 if (des.idVendor != devc->profile->vid
225 || des.idProduct != devc->profile->pid)
226 continue;
227
228 if (sdi->status == SR_ST_INITIALIZING) {
229 if (skip != sdi->index) {
230 /* Skip devices of this type that aren't the one we want. */
231 skip += 1;
232 continue;
233 }
234 } else if (sdi->status == SR_ST_INACTIVE) {
235 /*
236 * This device is fully enumerated, so we need to find
237 * this device by vendor, product, bus and address.
238 */
239 if (libusb_get_bus_number(devlist[i]) != devc->usb->bus
240 || libusb_get_device_address(devlist[i]) != devc->usb->address)
241 /* This is not the one. */
242 continue;
243 }
244
245 if (!(ret = libusb_open(devlist[i], &devc->usb->devhdl))) {
246 if (devc->usb->address == 0xff)
247 /*
248 * First time we touch this device after FW
249 * upload, so we don't know the address yet.
250 */
251 devc->usb->address = libusb_get_device_address(devlist[i]);
252 } else {
253 sr_err("Failed to open device: %s.",
254 libusb_error_name(ret));
255 break;
256 }
257
258 ret = command_get_fw_version(devc->usb->devhdl, &vi);
259 if (ret != SR_OK) {
260 sr_err("Failed to get firmware version.");
261 break;
262 }
263
264 ret = command_get_revid_version(devc->usb->devhdl, &revid);
265 if (ret != SR_OK) {
266 sr_err("Failed to get REVID.");
267 break;
268 }
269
270 /*
271 * Changes in major version mean incompatible/API changes, so
272 * bail out if we encounter an incompatible version.
273 * Different minor versions are OK, they should be compatible.
274 */
275 if (vi.major != FX2LAFW_REQUIRED_VERSION_MAJOR) {
276 sr_err("Expected firmware version %d.x, "
277 "got %d.%d.", FX2LAFW_REQUIRED_VERSION_MAJOR,
278 vi.major, vi.minor);
279 break;
280 }
281
282 sdi->status = SR_ST_ACTIVE;
283 sr_info("Opened device %d on %d.%d, "
284 "interface %d, firmware %d.%d, REVID %d.",
285 sdi->index, devc->usb->bus, devc->usb->address,
286 USB_INTERFACE, vi.major, vi.minor, revid);
287
288 break;
289 }
290 libusb_free_device_list(devlist, 1);
291
292 if (sdi->status != SR_ST_ACTIVE)
293 return SR_ERR;
294
295 return SR_OK;
296}
297
298static int configure_probes(const struct sr_dev_inst *sdi)
299{
300 struct dev_context *devc;
301 struct sr_probe *probe;
302 GSList *l;
303 int probe_bit, stage, i;
304 char *tc;
305
306 devc = sdi->priv;
307 for (i = 0; i < NUM_TRIGGER_STAGES; i++) {
308 devc->trigger_mask[i] = 0;
309 devc->trigger_value[i] = 0;
310 }
311
312 stage = -1;
313 for (l = sdi->probes; l; l = l->next) {
314 probe = (struct sr_probe *)l->data;
315 if (probe->enabled == FALSE)
316 continue;
317
318 if (probe->index > 7)
319 devc->sample_wide = TRUE;
320
321 probe_bit = 1 << (probe->index);
322 if (!(probe->trigger))
323 continue;
324
325 stage = 0;
326 for (tc = probe->trigger; *tc; tc++) {
327 devc->trigger_mask[stage] |= probe_bit;
328 if (*tc == '1')
329 devc->trigger_value[stage] |= probe_bit;
330 stage++;
331 if (stage > NUM_TRIGGER_STAGES)
332 return SR_ERR;
333 }
334 }
335
336 if (stage == -1)
337 /*
338 * We didn't configure any triggers, make sure acquisition
339 * doesn't wait for any.
340 */
341 devc->trigger_stage = TRIGGER_FIRED;
342 else
343 devc->trigger_stage = 0;
344
345 return SR_OK;
346}
347
348static struct dev_context *fx2lafw_dev_new(void)
349{
350 struct dev_context *devc;
351
352 if (!(devc = g_try_malloc0(sizeof(struct dev_context)))) {
353 sr_err("Device context malloc failed.");
354 return NULL;
355 }
356
357 devc->trigger_stage = TRIGGER_FIRED;
358
359 return devc;
360}
361
362static int clear_instances(void)
363{
364 GSList *l;
365 struct sr_dev_inst *sdi;
366 struct drv_context *drvc;
367 struct dev_context *devc;
368 int ret;
369
370 drvc = di->priv;
371 ret = SR_OK;
372 for (l = drvc->instances; l; l = l->next) {
373 if (!(sdi = l->data)) {
374 /* Log error, but continue cleaning up the rest. */
375 sr_err("sdi was NULL, continuing.");
376 ret = SR_ERR_BUG;
377 continue;
378 }
379 if (!(devc = sdi->priv)) {
380 /* Log error, but continue cleaning up the rest. */
381 sr_err("sdi->priv was NULL, continuing.");
382 ret = SR_ERR_BUG;
383 continue;
384 }
385 hw_dev_close(sdi);
386 sr_usb_dev_inst_free(devc->usb);
387 sdi = l->data;
388 sr_dev_inst_free(sdi);
389 }
390
391 g_slist_free(drvc->instances);
392 drvc->instances = NULL;
393
394 return ret;
395}
396
397static int hw_init(struct sr_context *sr_ctx)
398{
399 struct drv_context *drvc;
400
401 if (!(drvc = g_try_malloc0(sizeof(struct drv_context)))) {
402 sr_err("Driver context malloc failed.");
403 return SR_ERR_MALLOC;
404 }
405
406 drvc->sr_ctx = sr_ctx;
407 di->priv = drvc;
408
409 return SR_OK;
410}
411
412static GSList *hw_scan(GSList *options)
413{
414 GSList *devices;
415 struct libusb_device_descriptor des;
416 struct sr_dev_inst *sdi;
417 const struct fx2lafw_profile *prof;
418 struct drv_context *drvc;
419 struct dev_context *devc;
420 struct sr_probe *probe;
421 libusb_device **devlist;
422 int devcnt, num_logic_probes, ret, i, j;
423
424 (void)options;
425
426 drvc = di->priv;
427
428 /* This scan always invalidates any previous scans. */
429 clear_instances();
430
431 /* Find all fx2lafw compatible devices and upload firmware to them. */
432 devices = NULL;
433 libusb_get_device_list(drvc->sr_ctx->libusb_ctx, &devlist);
434 for (i = 0; devlist[i]; i++) {
435
436 if ((ret = libusb_get_device_descriptor(
437 devlist[i], &des)) != 0) {
438 sr_warn("Failed to get device descriptor: %s.",
439 libusb_error_name(ret));
440 continue;
441 }
442
443 prof = NULL;
444 for (j = 0; supported_fx2[j].vid; j++) {
445 if (des.idVendor == supported_fx2[j].vid &&
446 des.idProduct == supported_fx2[j].pid) {
447 prof = &supported_fx2[j];
448 }
449 }
450
451 /* Skip if the device was not found. */
452 if (!prof)
453 continue;
454
455 devcnt = g_slist_length(drvc->instances);
456 sdi = sr_dev_inst_new(devcnt, SR_ST_INITIALIZING,
457 prof->vendor, prof->model, prof->model_version);
458 if (!sdi)
459 return NULL;
460 sdi->driver = di;
461
462 /* Fill in probelist according to this device's profile. */
463 num_logic_probes = prof->dev_caps & DEV_CAPS_16BIT ? 16 : 8;
464 for (j = 0; j < num_logic_probes; j++) {
465 if (!(probe = sr_probe_new(j, SR_PROBE_LOGIC, TRUE,
466 probe_names[j])))
467 return NULL;
468 sdi->probes = g_slist_append(sdi->probes, probe);
469 }
470
471 devc = fx2lafw_dev_new();
472 devc->profile = prof;
473 sdi->priv = devc;
474 drvc->instances = g_slist_append(drvc->instances, sdi);
475 devices = g_slist_append(devices, sdi);
476
477 if (check_conf_profile(devlist[i])) {
478 /* Already has the firmware, so fix the new address. */
479 sr_dbg("Found an fx2lafw device.");
480 sdi->status = SR_ST_INACTIVE;
481 devc->usb = sr_usb_dev_inst_new
482 (libusb_get_bus_number(devlist[i]),
483 libusb_get_device_address(devlist[i]), NULL);
484 } else {
485 if (ezusb_upload_firmware(devlist[i], USB_CONFIGURATION,
486 prof->firmware) == SR_OK)
487 /* Store when this device's FW was updated. */
488 devc->fw_updated = g_get_monotonic_time();
489 else
490 sr_err("Firmware upload failed for "
491 "device %d.", devcnt);
492 devc->usb = sr_usb_dev_inst_new
493 (libusb_get_bus_number(devlist[i]), 0xff, NULL);
494 }
495 }
496 libusb_free_device_list(devlist, 1);
497
498 return devices;
499}
500
501static GSList *hw_dev_list(void)
502{
503 struct drv_context *drvc;
504
505 drvc = di->priv;
506
507 return drvc->instances;
508}
509
510static int hw_dev_open(struct sr_dev_inst *sdi)
511{
512 struct dev_context *devc;
513 int ret;
514 int64_t timediff_us, timediff_ms;
515
516 devc = sdi->priv;
517
518 /*
519 * If the firmware was recently uploaded, wait up to MAX_RENUM_DELAY_MS
520 * milliseconds for the FX2 to renumerate.
521 */
522 ret = SR_ERR;
523 if (devc->fw_updated > 0) {
524 sr_info("Waiting for device to reset.");
525 /* Takes >= 300ms for the FX2 to be gone from the USB bus. */
526 g_usleep(300 * 1000);
527 timediff_ms = 0;
528 while (timediff_ms < MAX_RENUM_DELAY_MS) {
529 if ((ret = fx2lafw_dev_open(sdi)) == SR_OK)
530 break;
531 g_usleep(100 * 1000);
532
533 timediff_us = g_get_monotonic_time() - devc->fw_updated;
534 timediff_ms = timediff_us / 1000;
535 sr_spew("Waited %" PRIi64 "ms.", timediff_ms);
536 }
537 if (ret != SR_OK) {
538 sr_err("Device failed to renumerate.");
539 return SR_ERR;
540 }
541 sr_info("Device came back after %" PRIi64 "ms.", timediff_ms);
542 } else {
543 sr_info("Firmware upload was not needed.");
544 ret = fx2lafw_dev_open(sdi);
545 }
546
547 if (ret != SR_OK) {
548 sr_err("Unable to open device.");
549 return SR_ERR;
550 }
551
552 devc = sdi->priv;
553
554 ret = libusb_claim_interface(devc->usb->devhdl, USB_INTERFACE);
555 if (ret != 0) {
556 switch(ret) {
557 case LIBUSB_ERROR_BUSY:
558 sr_err("Unable to claim USB interface. Another "
559 "program or driver has already claimed it.");
560 break;
561 case LIBUSB_ERROR_NO_DEVICE:
562 sr_err("Device has been disconnected.");
563 break;
564 default:
565 sr_err("Unable to claim interface: %s.",
566 libusb_error_name(ret));
567 break;
568 }
569
570 return SR_ERR;
571 }
572
573 if (devc->cur_samplerate == 0) {
574 /* Samplerate hasn't been set; default to the slowest one. */
575 if (hw_dev_config_set(sdi, SR_HWCAP_SAMPLERATE,
576 &supported_samplerates[0]) == SR_ERR)
577 return SR_ERR;
578 }
579
580 return SR_OK;
581}
582
583static int hw_dev_close(struct sr_dev_inst *sdi)
584{
585 struct dev_context *devc;
586
587 devc = sdi->priv;
588 if (devc->usb->devhdl == NULL)
589 return SR_ERR;
590
591 sr_info("Closing device %d on %d.%d, interface %d.",
592 sdi->index, devc->usb->bus, devc->usb->address, USB_INTERFACE);
593 libusb_release_interface(devc->usb->devhdl, USB_INTERFACE);
594 libusb_close(devc->usb->devhdl);
595 devc->usb->devhdl = NULL;
596 sdi->status = SR_ST_INACTIVE;
597
598 return SR_OK;
599}
600
601static int hw_cleanup(void)
602{
603 struct drv_context *drvc;
604 int ret;
605
606 if (!(drvc = di->priv))
607 return SR_OK;
608
609 ret = clear_instances();
610
611 g_free(drvc);
612 di->priv = NULL;
613
614 return ret;
615}
616
617static int hw_info_get(int info_id, const void **data,
618 const struct sr_dev_inst *sdi)
619{
620 struct dev_context *devc;
621
622 switch (info_id) {
623 case SR_DI_HWCAPS:
624 *data = hwcaps;
625 break;
626 case SR_DI_NUM_PROBES:
627 if (sdi) {
628 devc = sdi->priv;
629 *data = GINT_TO_POINTER(
630 (devc->profile->dev_caps & DEV_CAPS_16BIT) ?
631 16 : 8);
632 } else
633 return SR_ERR;
634 break;
635 case SR_DI_PROBE_NAMES:
636 *data = probe_names;
637 break;
638 case SR_DI_SAMPLERATES:
639 *data = &samplerates;
640 break;
641 case SR_DI_TRIGGER_TYPES:
642 *data = TRIGGER_TYPES;
643 break;
644 case SR_DI_CUR_SAMPLERATE:
645 if (sdi) {
646 devc = sdi->priv;
647 *data = &devc->cur_samplerate;
648 } else
649 return SR_ERR;
650 break;
651 default:
652 return SR_ERR_ARG;
653 }
654
655 return SR_OK;
656}
657
658static int hw_dev_config_set(const struct sr_dev_inst *sdi, int hwcap,
659 const void *value)
660{
661 struct dev_context *devc;
662 int ret;
663
664 devc = sdi->priv;
665
666 if (hwcap == SR_HWCAP_SAMPLERATE) {
667 devc->cur_samplerate = *(const uint64_t *)value;
668 ret = SR_OK;
669 } else if (hwcap == SR_HWCAP_LIMIT_SAMPLES) {
670 devc->limit_samples = *(const uint64_t *)value;
671 ret = SR_OK;
672 } else {
673 ret = SR_ERR;
674 }
675
676 return ret;
677}
678
679static int receive_data(int fd, int revents, void *cb_data)
680{
681 struct timeval tv;
682 struct drv_context *drvc;
683
684 (void)fd;
685 (void)revents;
686 (void)cb_data;
687
688 drvc = di->priv;
689
690 tv.tv_sec = tv.tv_usec = 0;
691 libusb_handle_events_timeout(drvc->sr_ctx->libusb_ctx, &tv);
692
693 return TRUE;
694}
695
696static void abort_acquisition(struct dev_context *devc)
697{
698 int i;
699
700 devc->num_samples = -1;
701
702 for (i = devc->num_transfers - 1; i >= 0; i--) {
703 if (devc->transfers[i])
704 libusb_cancel_transfer(devc->transfers[i]);
705 }
706}
707
708static void finish_acquisition(struct dev_context *devc)
709{
710 struct sr_datafeed_packet packet;
711 struct drv_context *drvc = di->priv;
712 const struct libusb_pollfd **lupfd;
713 int i;
714
715 /* Terminate session. */
716 packet.type = SR_DF_END;
717 sr_session_send(devc->session_dev_id, &packet);
718
719 /* Remove fds from polling. */
720 lupfd = libusb_get_pollfds(drvc->sr_ctx->libusb_ctx);
721 for (i = 0; lupfd[i]; i++)
722 sr_source_remove(lupfd[i]->fd);
723 free(lupfd); /* NOT g_free()! */
724
725 devc->num_transfers = 0;
726 g_free(devc->transfers);
727}
728
729static void free_transfer(struct libusb_transfer *transfer)
730{
731 struct dev_context *devc;
732 unsigned int i;
733
734 devc = transfer->user_data;
735
736 g_free(transfer->buffer);
737 transfer->buffer = NULL;
738 libusb_free_transfer(transfer);
739
740 for (i = 0; i < devc->num_transfers; i++) {
741 if (devc->transfers[i] == transfer) {
742 devc->transfers[i] = NULL;
743 break;
744 }
745 }
746
747 devc->submitted_transfers--;
748 if (devc->submitted_transfers == 0)
749 finish_acquisition(devc);
750}
751
752static void resubmit_transfer(struct libusb_transfer *transfer)
753{
754 int ret;
755
756 if ((ret = libusb_submit_transfer(transfer)) == LIBUSB_SUCCESS)
757 return;
758
759 free_transfer(transfer);
760 /* TODO: Stop session? */
761
762 sr_err("%s: %s", __func__, libusb_error_name(ret));
763}
764
765static void receive_transfer(struct libusb_transfer *transfer)
766{
767 gboolean packet_has_error = FALSE;
768 struct sr_datafeed_packet packet;
769 struct sr_datafeed_logic logic;
770 struct dev_context *devc;
771 int trigger_offset, i, sample_width, cur_sample_count;
772 int trigger_offset_bytes;
773 uint8_t *cur_buf;
774
775 devc = transfer->user_data;
776
777 /*
778 * If acquisition has already ended, just free any queued up
779 * transfer that come in.
780 */
781 if (devc->num_samples == -1) {
782 free_transfer(transfer);
783 return;
784 }
785
786 sr_info("receive_transfer(): status %d received %d bytes.",
787 transfer->status, transfer->actual_length);
788
789 /* Save incoming transfer before reusing the transfer struct. */
790 cur_buf = transfer->buffer;
791 sample_width = devc->sample_wide ? 2 : 1;
792 cur_sample_count = transfer->actual_length / sample_width;
793
794 switch (transfer->status) {
795 case LIBUSB_TRANSFER_NO_DEVICE:
796 abort_acquisition(devc);
797 free_transfer(transfer);
798 return;
799 case LIBUSB_TRANSFER_COMPLETED:
800 case LIBUSB_TRANSFER_TIMED_OUT: /* We may have received some data though. */
801 break;
802 default:
803 packet_has_error = TRUE;
804 break;
805 }
806
807 if (transfer->actual_length == 0 || packet_has_error) {
808 devc->empty_transfer_count++;
809 if (devc->empty_transfer_count > MAX_EMPTY_TRANSFERS) {
810 /*
811 * The FX2 gave up. End the acquisition, the frontend
812 * will work out that the samplecount is short.
813 */
814 abort_acquisition(devc);
815 free_transfer(transfer);
816 } else {
817 resubmit_transfer(transfer);
818 }
819 return;
820 } else {
821 devc->empty_transfer_count = 0;
822 }
823
824 trigger_offset = 0;
825 if (devc->trigger_stage >= 0) {
826 for (i = 0; i < cur_sample_count; i++) {
827
828 const uint16_t cur_sample = devc->sample_wide ?
829 *((const uint16_t*)cur_buf + i) :
830 *((const uint8_t*)cur_buf + i);
831
832 if ((cur_sample & devc->trigger_mask[devc->trigger_stage]) ==
833 devc->trigger_value[devc->trigger_stage]) {
834 /* Match on this trigger stage. */
835 devc->trigger_buffer[devc->trigger_stage] = cur_sample;
836 devc->trigger_stage++;
837
838 if (devc->trigger_stage == NUM_TRIGGER_STAGES ||
839 devc->trigger_mask[devc->trigger_stage] == 0) {
840 /* Match on all trigger stages, we're done. */
841 trigger_offset = i + 1;
842
843 /*
844 * TODO: Send pre-trigger buffer to session bus.
845 * Tell the frontend we hit the trigger here.
846 */
847 packet.type = SR_DF_TRIGGER;
848 packet.payload = NULL;
849 sr_session_send(devc->session_dev_id, &packet);
850
851 /*
852 * Send the samples that triggered it,
853 * since we're skipping past them.
854 */
855 packet.type = SR_DF_LOGIC;
856 packet.payload = &logic;
857 logic.unitsize = sizeof(*devc->trigger_buffer);
858 logic.length = devc->trigger_stage * logic.unitsize;
859 logic.data = devc->trigger_buffer;
860 sr_session_send(devc->session_dev_id, &packet);
861
862 devc->trigger_stage = TRIGGER_FIRED;
863 break;
864 }
865 } else if (devc->trigger_stage > 0) {
866 /*
867 * We had a match before, but not in the next sample. However, we may
868 * have a match on this stage in the next bit -- trigger on 0001 will
869 * fail on seeing 00001, so we need to go back to stage 0 -- but at
870 * the next sample from the one that matched originally, which the
871 * counter increment at the end of the loop takes care of.
872 */
873 i -= devc->trigger_stage;
874 if (i < -1)
875 i = -1; /* Oops, went back past this buffer. */
876 /* Reset trigger stage. */
877 devc->trigger_stage = 0;
878 }
879 }
880 }
881
882 if (devc->trigger_stage == TRIGGER_FIRED) {
883 /* Send the incoming transfer to the session bus. */
884 trigger_offset_bytes = trigger_offset * sample_width;
885 packet.type = SR_DF_LOGIC;
886 packet.payload = &logic;
887 logic.length = transfer->actual_length - trigger_offset_bytes;
888 logic.unitsize = sample_width;
889 logic.data = cur_buf + trigger_offset_bytes;
890 sr_session_send(devc->session_dev_id, &packet);
891
892 devc->num_samples += cur_sample_count;
893 if (devc->limit_samples &&
894 (unsigned int)devc->num_samples > devc->limit_samples) {
895 abort_acquisition(devc);
896 free_transfer(transfer);
897 return;
898 }
899 } else {
900 /*
901 * TODO: Buffer pre-trigger data in capture
902 * ratio-sized buffer.
903 */
904 }
905
906 resubmit_transfer(transfer);
907}
908
909static unsigned int to_bytes_per_ms(unsigned int samplerate)
910{
911 return samplerate / 1000;
912}
913
914static size_t get_buffer_size(struct dev_context *devc)
915{
916 size_t s;
917
918 /*
919 * The buffer should be large enough to hold 10ms of data and
920 * a multiple of 512.
921 */
922 s = 10 * to_bytes_per_ms(devc->cur_samplerate);
923 return (s + 511) & ~511;
924}
925
926static unsigned int get_number_of_transfers(struct dev_context *devc)
927{
928 unsigned int n;
929
930 /* Total buffer size should be able to hold about 500ms of data. */
931 n = 500 * to_bytes_per_ms(devc->cur_samplerate) / get_buffer_size(devc);
932
933 if (n > NUM_SIMUL_TRANSFERS)
934 return NUM_SIMUL_TRANSFERS;
935
936 return n;
937}
938
939static unsigned int get_timeout(struct dev_context *devc)
940{
941 size_t total_size;
942 unsigned int timeout;
943
944 total_size = get_buffer_size(devc) * get_number_of_transfers(devc);
945 timeout = total_size / to_bytes_per_ms(devc->cur_samplerate);
946 return timeout + timeout / 4; /* Leave a headroom of 25% percent. */
947}
948
949static int hw_dev_acquisition_start(const struct sr_dev_inst *sdi,
950 void *cb_data)
951{
952 struct sr_datafeed_packet packet;
953 struct sr_datafeed_header header;
954 struct sr_datafeed_meta_logic meta;
955 struct dev_context *devc;
956 struct drv_context *drvc;
957 struct libusb_transfer *transfer;
958 const struct libusb_pollfd **lupfd;
959 unsigned int i, timeout, num_transfers;
960 int ret;
961 unsigned char *buf;
962 size_t size;
963
964 drvc = di->priv;
965 devc = sdi->priv;
966
967 if (devc->submitted_transfers != 0)
968 return SR_ERR;
969
970 if (configure_probes(sdi) != SR_OK) {
971 sr_err("Failed to configure probes.");
972 return SR_ERR;
973 }
974
975 devc->session_dev_id = cb_data;
976 devc->num_samples = 0;
977 devc->empty_transfer_count = 0;
978
979 timeout = get_timeout(devc);
980 num_transfers = get_number_of_transfers(devc);
981 size = get_buffer_size(devc);
982
983 devc->transfers = g_try_malloc0(sizeof(*devc->transfers) * num_transfers);
984 if (!devc->transfers) {
985 sr_err("USB transfers malloc failed.");
986 return SR_ERR_MALLOC;
987 }
988
989 devc->num_transfers = num_transfers;
990
991 for (i = 0; i < num_transfers; i++) {
992 if (!(buf = g_try_malloc(size))) {
993 sr_err("USB transfer buffer malloc failed.");
994 return SR_ERR_MALLOC;
995 }
996 transfer = libusb_alloc_transfer(0);
997 libusb_fill_bulk_transfer(transfer, devc->usb->devhdl,
998 2 | LIBUSB_ENDPOINT_IN, buf, size,
999 receive_transfer, devc, timeout);
1000 if ((ret = libusb_submit_transfer(transfer)) != 0) {
1001 sr_err("Failed to submit transfer: %s.",
1002 libusb_error_name(ret));
1003 libusb_free_transfer(transfer);
1004 g_free(buf);
1005 abort_acquisition(devc);
1006 return SR_ERR;
1007 }
1008 devc->transfers[i] = transfer;
1009 devc->submitted_transfers++;
1010 }
1011
1012 lupfd = libusb_get_pollfds(drvc->sr_ctx->libusb_ctx);
1013 for (i = 0; lupfd[i]; i++)
1014 sr_source_add(lupfd[i]->fd, lupfd[i]->events,
1015 timeout, receive_data, NULL);
1016 free(lupfd); /* NOT g_free()! */
1017
1018 packet.type = SR_DF_HEADER;
1019 packet.payload = &header;
1020 header.feed_version = 1;
1021 gettimeofday(&header.starttime, NULL);
1022 sr_session_send(cb_data, &packet);
1023
1024 /* Send metadata about the SR_DF_LOGIC packets to come. */
1025 packet.type = SR_DF_META_LOGIC;
1026 packet.payload = &meta;
1027 meta.samplerate = devc->cur_samplerate;
1028 meta.num_probes = devc->sample_wide ? 16 : 8;
1029 sr_session_send(cb_data, &packet);
1030
1031 if ((ret = command_start_acquisition(devc->usb->devhdl,
1032 devc->cur_samplerate, devc->sample_wide)) != SR_OK) {
1033 abort_acquisition(devc);
1034 return ret;
1035 }
1036
1037 return SR_OK;
1038}
1039
1040/* TODO: This stops acquisition on ALL devices, ignoring dev_index. */
1041static int hw_dev_acquisition_stop(struct sr_dev_inst *sdi, void *cb_data)
1042{
1043 (void)cb_data;
1044
1045 abort_acquisition(sdi->priv);
1046
1047 return SR_OK;
1048}
1049
1050SR_PRIV struct sr_dev_driver fx2lafw_driver_info = {
1051 .name = "fx2lafw",
1052 .longname = "fx2lafw (generic driver for FX2 based LAs)",
1053 .api_version = 1,
1054 .init = hw_init,
1055 .cleanup = hw_cleanup,
1056 .scan = hw_scan,
1057 .dev_list = hw_dev_list,
1058 .dev_clear = clear_instances,
1059 .dev_open = hw_dev_open,
1060 .dev_close = hw_dev_close,
1061 .info_get = hw_info_get,
1062 .dev_config_set = hw_dev_config_set,
1063 .dev_acquisition_start = hw_dev_acquisition_start,
1064 .dev_acquisition_stop = hw_dev_acquisition_stop,
1065 .priv = NULL,
1066};
Hardware access and backend lib