]>
Commit | Line | Data |
---|---|---|
f302a082 | 1 | /* |
50985c20 | 2 | * This file is part of the libsigrok project. |
f302a082 | 3 | * |
13d8e03c | 4 | * Copyright (C) 2013 Bert Vermeulen <bert@biot.com> |
f302a082 JH |
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 | ||
6ec6c43b | 21 | #include <config.h> |
2f937611 | 22 | #include "protocol.h" |
3fc3fbe4 | 23 | #include <math.h> |
f302a082 | 24 | |
4679d14d | 25 | static const struct fx2lafw_profile supported_fx2[] = { |
7ae2f9d5 UH |
26 | /* |
27 | * CWAV USBee AX | |
17b6c75a | 28 | * EE Electronics ESLA201A |
9f05304e | 29 | * ARMFLY AX-Pro |
17b6c75a | 30 | */ |
f8b07fc6 | 31 | { 0x08a9, 0x0014, "CWAV", "USBee AX", NULL, |
8e2d6c9d | 32 | "fx2lafw-cwav-usbeeax.fw", |
232a975f | 33 | DEV_CAPS_AX_ANALOG, NULL, NULL}, |
0e8d0e24 IF |
34 | /* |
35 | * CWAV USBee DX | |
36 | * XZL-Studio DX | |
37 | */ | |
38 | { 0x08a9, 0x0015, "CWAV", "USBee DX", NULL, | |
8e2d6c9d | 39 | "fx2lafw-cwav-usbeedx.fw", |
e826239c | 40 | DEV_CAPS_16BIT, NULL, NULL }, |
93a9f3da | 41 | |
7ae2f9d5 UH |
42 | /* |
43 | * CWAV USBee SX | |
4502e869 JH |
44 | */ |
45 | { 0x08a9, 0x0009, "CWAV", "USBee SX", NULL, | |
8e2d6c9d | 46 | "fx2lafw-cwav-usbeesx.fw", |
e826239c | 47 | 0, NULL, NULL}, |
4502e869 | 48 | |
2f4b0f6a T |
49 | /* |
50 | * CWAV USBee ZX | |
51 | */ | |
52 | { 0x08a9, 0x0005, "CWAV", "USBee ZX", NULL, | |
53 | "fx2lafw-cwav-usbeezx.fw", | |
54 | 0, NULL, NULL}, | |
55 | ||
7ae2f9d5 UH |
56 | /* |
57 | * Saleae Logic | |
93a9f3da JH |
58 | * EE Electronics ESLA100 |
59 | * Robomotic MiniLogic | |
1663e470 | 60 | * Robomotic BugLogic 3 |
93a9f3da JH |
61 | */ |
62 | { 0x0925, 0x3881, "Saleae", "Logic", NULL, | |
8e2d6c9d | 63 | "fx2lafw-saleae-logic.fw", |
e826239c | 64 | 0, NULL, NULL}, |
93a9f3da | 65 | |
f488762a | 66 | /* |
1663e470 UH |
67 | * Default Cypress FX2 without EEPROM, e.g.: |
68 | * Lcsoft Mini Board | |
69 | * Braintechnology USB Interface V2.x | |
f488762a JH |
70 | */ |
71 | { 0x04B4, 0x8613, "Cypress", "FX2", NULL, | |
8e2d6c9d | 72 | "fx2lafw-cypress-fx2.fw", |
e826239c | 73 | DEV_CAPS_16BIT, NULL, NULL }, |
f488762a | 74 | |
1663e470 UH |
75 | /* |
76 | * Braintechnology USB-LPS | |
77 | */ | |
78 | { 0x16d0, 0x0498, "Braintechnology", "USB-LPS", NULL, | |
8e2d6c9d | 79 | "fx2lafw-braintechnology-usb-lps.fw", |
e826239c | 80 | DEV_CAPS_16BIT, NULL, NULL }, |
1663e470 | 81 | |
3e91de2b UH |
82 | /* |
83 | * sigrok FX2 based 8-channel logic analyzer | |
84 | */ | |
85 | { 0x1d50, 0x608c, "sigrok", "FX2 LA (8ch)", NULL, | |
087c4d59 | 86 | "fx2lafw-sigrok-fx2-8ch.fw", |
3e91de2b UH |
87 | 0, NULL, NULL}, |
88 | ||
89 | /* | |
90 | * sigrok FX2 based 16-channel logic analyzer | |
91 | */ | |
92 | { 0x1d50, 0x608d, "sigrok", "FX2 LA (16ch)", NULL, | |
087c4d59 | 93 | "fx2lafw-sigrok-fx2-16ch.fw", |
3e91de2b UH |
94 | DEV_CAPS_16BIT, NULL, NULL }, |
95 | ||
1b4aedc0 | 96 | ALL_ZERO |
187b3582 JH |
97 | }; |
98 | ||
ff6b76a1 BV |
99 | static const uint32_t drvopts[] = { |
100 | SR_CONF_LOGIC_ANALYZER, | |
101 | }; | |
102 | ||
a0e0bb41 | 103 | static const uint32_t scanopts[] = { |
89befd46 BV |
104 | SR_CONF_CONN, |
105 | }; | |
106 | ||
f254bc4b | 107 | static const uint32_t devopts[] = { |
e91bb0a6 | 108 | SR_CONF_CONTINUOUS, |
ff6b76a1 | 109 | SR_CONF_LIMIT_SAMPLES | SR_CONF_GET | SR_CONF_SET, |
5827f61b BV |
110 | SR_CONF_CONN | SR_CONF_GET, |
111 | SR_CONF_SAMPLERATE | SR_CONF_GET | SR_CONF_SET | SR_CONF_LIST, | |
5827f61b | 112 | SR_CONF_TRIGGER_MATCH | SR_CONF_LIST, |
7bfcb25c | 113 | SR_CONF_CAPTURE_RATIO | SR_CONF_GET | SR_CONF_SET, |
8b35f474 JH |
114 | }; |
115 | ||
9615eeb5 BV |
116 | static const int32_t soft_trigger_matches[] = { |
117 | SR_TRIGGER_ZERO, | |
118 | SR_TRIGGER_ONE, | |
335122f0 BV |
119 | SR_TRIGGER_RISING, |
120 | SR_TRIGGER_FALLING, | |
121 | SR_TRIGGER_EDGE, | |
9615eeb5 BV |
122 | }; |
123 | ||
d6836bf1 | 124 | static const uint64_t samplerates[] = { |
79dc6498 JH |
125 | SR_KHZ(20), |
126 | SR_KHZ(25), | |
897c1a2e JH |
127 | SR_KHZ(50), |
128 | SR_KHZ(100), | |
9304d576 JH |
129 | SR_KHZ(200), |
130 | SR_KHZ(250), | |
131 | SR_KHZ(500), | |
8b35f474 JH |
132 | SR_MHZ(1), |
133 | SR_MHZ(2), | |
134 | SR_MHZ(3), | |
135 | SR_MHZ(4), | |
136 | SR_MHZ(6), | |
137 | SR_MHZ(8), | |
138 | SR_MHZ(12), | |
139 | SR_MHZ(16), | |
772a0e61 | 140 | SR_MHZ(24), |
8b35f474 JH |
141 | }; |
142 | ||
7087a8b0 KP |
143 | static gboolean is_plausible(const struct libusb_device_descriptor *des) |
144 | { | |
145 | int i; | |
146 | ||
147 | for (i = 0; supported_fx2[i].vid; i++) { | |
148 | if (des->idVendor != supported_fx2[i].vid) | |
149 | continue; | |
150 | if (des->idProduct == supported_fx2[i].pid) | |
151 | return TRUE; | |
152 | } | |
153 | ||
154 | return FALSE; | |
155 | } | |
156 | ||
4f840ce9 | 157 | static GSList *scan(struct sr_dev_driver *di, GSList *options) |
f302a082 | 158 | { |
dc9dbe94 BV |
159 | struct drv_context *drvc; |
160 | struct dev_context *devc; | |
754b5ff2 BV |
161 | struct sr_dev_inst *sdi; |
162 | struct sr_usb_dev_inst *usb; | |
7fb90f94 BL |
163 | struct sr_channel *ch; |
164 | struct sr_channel_group *cg; | |
754b5ff2 BV |
165 | struct sr_config *src; |
166 | const struct fx2lafw_profile *prof; | |
167 | GSList *l, *devices, *conn_devices; | |
a7d7f93c | 168 | gboolean has_firmware; |
754b5ff2 | 169 | struct libusb_device_descriptor des; |
187b3582 | 170 | libusb_device **devlist; |
e826239c | 171 | struct libusb_device_handle *hdl; |
232a975f JH |
172 | int ret, i, j; |
173 | int num_logic_channels = 0, num_analog_channels = 0; | |
754b5ff2 | 174 | const char *conn; |
5e2c86eb | 175 | char manufacturer[64], product[64], serial_num[64], connection_id[64]; |
7fb90f94 | 176 | char channel_name[16]; |
3a7a22cb | 177 | |
41812aca | 178 | drvc = di->context; |
187b3582 | 179 | |
754b5ff2 BV |
180 | conn = NULL; |
181 | for (l = options; l; l = l->next) { | |
182 | src = l->data; | |
183 | switch (src->key) { | |
184 | case SR_CONF_CONN: | |
185 | conn = g_variant_get_string(src->data, NULL); | |
186 | break; | |
187 | } | |
188 | } | |
189 | if (conn) | |
190 | conn_devices = sr_usb_find(drvc->sr_ctx->libusb_ctx, conn); | |
191 | else | |
192 | conn_devices = NULL; | |
193 | ||
921634ec | 194 | /* Find all fx2lafw compatible devices and upload firmware to them. */ |
3a7a22cb | 195 | devices = NULL; |
d4abb463 | 196 | libusb_get_device_list(drvc->sr_ctx->libusb_ctx, &devlist); |
187b3582 | 197 | for (i = 0; devlist[i]; i++) { |
754b5ff2 BV |
198 | if (conn) { |
199 | usb = NULL; | |
200 | for (l = conn_devices; l; l = l->next) { | |
201 | usb = l->data; | |
202 | if (usb->bus == libusb_get_bus_number(devlist[i]) | |
203 | && usb->address == libusb_get_device_address(devlist[i])) | |
204 | break; | |
205 | } | |
206 | if (!l) | |
207 | /* This device matched none of the ones that | |
208 | * matched the conn specification. */ | |
209 | continue; | |
210 | } | |
187b3582 | 211 | |
2a8f2d41 | 212 | libusb_get_device_descriptor( devlist[i], &des); |
187b3582 | 213 | |
7087a8b0 KP |
214 | if (!is_plausible(&des)) |
215 | continue; | |
216 | ||
217 | if ((ret = libusb_open(devlist[i], &hdl)) < 0) { | |
218 | sr_warn("Failed to open potential device with " | |
219 | "VID:PID %04x:%04x: %s.", des.idVendor, | |
220 | des.idProduct, libusb_error_name(ret)); | |
e826239c | 221 | continue; |
7087a8b0 | 222 | } |
e826239c ML |
223 | |
224 | if (des.iManufacturer == 0) { | |
225 | manufacturer[0] = '\0'; | |
226 | } else if ((ret = libusb_get_string_descriptor_ascii(hdl, | |
227 | des.iManufacturer, (unsigned char *) manufacturer, | |
228 | sizeof(manufacturer))) < 0) { | |
229 | sr_warn("Failed to get manufacturer string descriptor: %s.", | |
230 | libusb_error_name(ret)); | |
231 | continue; | |
232 | } | |
233 | ||
234 | if (des.iProduct == 0) { | |
235 | product[0] = '\0'; | |
236 | } else if ((ret = libusb_get_string_descriptor_ascii(hdl, | |
237 | des.iProduct, (unsigned char *) product, | |
238 | sizeof(product))) < 0) { | |
239 | sr_warn("Failed to get product string descriptor: %s.", | |
240 | libusb_error_name(ret)); | |
241 | continue; | |
242 | } | |
243 | ||
5e2c86eb SA |
244 | if (des.iSerialNumber == 0) { |
245 | serial_num[0] = '\0'; | |
246 | } else if ((ret = libusb_get_string_descriptor_ascii(hdl, | |
247 | des.iSerialNumber, (unsigned char *) serial_num, | |
248 | sizeof(serial_num))) < 0) { | |
249 | sr_warn("Failed to get serial number string descriptor: %s.", | |
250 | libusb_error_name(ret)); | |
251 | continue; | |
252 | } | |
253 | ||
254 | usb_get_port_path(devlist[i], connection_id, sizeof(connection_id)); | |
255 | ||
e826239c ML |
256 | libusb_close(hdl); |
257 | ||
da686568 | 258 | prof = NULL; |
187b3582 JH |
259 | for (j = 0; supported_fx2[j].vid; j++) { |
260 | if (des.idVendor == supported_fx2[j].vid && | |
e826239c ML |
261 | des.idProduct == supported_fx2[j].pid && |
262 | (!supported_fx2[j].usb_manufacturer || | |
263 | !strcmp(manufacturer, supported_fx2[j].usb_manufacturer)) && | |
fef90b41 | 264 | (!supported_fx2[j].usb_product || |
e826239c | 265 | !strcmp(product, supported_fx2[j].usb_product))) { |
da686568 | 266 | prof = &supported_fx2[j]; |
e826239c | 267 | break; |
187b3582 JH |
268 | } |
269 | } | |
270 | ||
b99457f0 | 271 | /* Skip if the device was not found. */ |
da686568 | 272 | if (!prof) |
187b3582 JH |
273 | continue; |
274 | ||
aac29cc1 | 275 | sdi = g_malloc0(sizeof(struct sr_dev_inst)); |
0af636be UH |
276 | sdi->status = SR_ST_INITIALIZING; |
277 | sdi->vendor = g_strdup(prof->vendor); | |
278 | sdi->model = g_strdup(prof->model); | |
279 | sdi->version = g_strdup(prof->model_version); | |
5e2c86eb SA |
280 | sdi->serial_num = g_strdup(serial_num); |
281 | sdi->connection_id = g_strdup(connection_id); | |
187b3582 | 282 | |
ba7dd8bb UH |
283 | /* Fill in channellist according to this device's profile. */ |
284 | num_logic_channels = prof->dev_caps & DEV_CAPS_16BIT ? 16 : 8; | |
232a975f JH |
285 | num_analog_channels = prof->dev_caps & DEV_CAPS_AX_ANALOG ? 1 : 0; |
286 | ||
7fb90f94 BL |
287 | /* Logic channels, all in one channel group. */ |
288 | cg = g_malloc0(sizeof(struct sr_channel_group)); | |
289 | cg->name = g_strdup("Logic"); | |
290 | for (j = 0; j < num_logic_channels; j++) { | |
291 | sprintf(channel_name, "D%d", j); | |
292 | ch = sr_channel_new(sdi, j, SR_CHANNEL_LOGIC, | |
293 | TRUE, channel_name); | |
294 | cg->channels = g_slist_append(cg->channels, ch); | |
295 | } | |
296 | sdi->channel_groups = g_slist_append(NULL, cg); | |
297 | ||
298 | for (j = 0; j < num_analog_channels; j++) { | |
299 | snprintf(channel_name, 16, "A%d", j); | |
300 | ch = sr_channel_new(sdi, j + num_logic_channels, | |
301 | SR_CHANNEL_ANALOG, TRUE, channel_name); | |
302 | ||
303 | /* Every analog channel gets its own channel group. */ | |
304 | cg = g_malloc0(sizeof(struct sr_channel_group)); | |
305 | cg->name = g_strdup(channel_name); | |
306 | cg->channels = g_slist_append(NULL, ch); | |
307 | sdi->channel_groups = g_slist_append(sdi->channel_groups, cg); | |
308 | } | |
232a975f | 309 | |
dc9dbe94 BV |
310 | devc = fx2lafw_dev_new(); |
311 | devc->profile = prof; | |
312 | sdi->priv = devc; | |
a8cc8e44 | 313 | devices = g_slist_append(devices, sdi); |
187b3582 | 314 | |
adcb9951 JH |
315 | devc->samplerates = samplerates; |
316 | devc->num_samplerates = ARRAY_SIZE(samplerates); | |
317 | has_firmware = usb_match_manuf_prod(devlist[i], | |
318 | "sigrok", "fx2lafw"); | |
a7d7f93c BV |
319 | |
320 | if (has_firmware) { | |
b1eeb67e | 321 | /* Already has the firmware, so fix the new address. */ |
f427daef | 322 | sr_dbg("Found an fx2lafw device."); |
b1eeb67e | 323 | sdi->status = SR_ST_INACTIVE; |
250a78c7 BV |
324 | sdi->inst_type = SR_INST_USB; |
325 | sdi->conn = sr_usb_dev_inst_new(libusb_get_bus_number(devlist[i]), | |
326 | libusb_get_device_address(devlist[i]), NULL); | |
b1eeb67e | 327 | } else { |
8e2d6c9d DE |
328 | if (ezusb_upload_firmware(drvc->sr_ctx, devlist[i], |
329 | USB_CONFIGURATION, prof->firmware) == SR_OK) | |
b99457f0 | 330 | /* Store when this device's FW was updated. */ |
dc9dbe94 | 331 | devc->fw_updated = g_get_monotonic_time(); |
b1eeb67e | 332 | else |
f427daef | 333 | sr_err("Firmware upload failed for " |
5e2c86eb SA |
334 | "device %d.%d (logical).", |
335 | libusb_get_bus_number(devlist[i]), | |
336 | libusb_get_device_address(devlist[i])); | |
250a78c7 | 337 | sdi->inst_type = SR_INST_USB; |
87b545fb | 338 | sdi->conn = sr_usb_dev_inst_new(libusb_get_bus_number(devlist[i]), |
250a78c7 | 339 | 0xff, NULL); |
b1eeb67e | 340 | } |
187b3582 JH |
341 | } |
342 | libusb_free_device_list(devlist, 1); | |
9dc7a75e | 343 | g_slist_free_full(conn_devices, (GDestroyNotify)sr_usb_dev_inst_free); |
187b3582 | 344 | |
15a5bfe4 | 345 | return std_scan_complete(di, devices); |
f302a082 JH |
346 | } |
347 | ||
7fb90f94 BL |
348 | static void clear_dev_context(void *priv) |
349 | { | |
350 | struct dev_context *devc; | |
351 | ||
352 | devc = priv; | |
353 | g_slist_free(devc->enabled_analog_channels); | |
354 | g_free(devc); | |
355 | } | |
356 | ||
357 | static int dev_clear(const struct sr_dev_driver *di) | |
358 | { | |
359 | return std_dev_clear(di, clear_dev_context); | |
360 | } | |
361 | ||
6078d2c9 | 362 | static int dev_open(struct sr_dev_inst *sdi) |
f302a082 | 363 | { |
4f840ce9 | 364 | struct sr_dev_driver *di = sdi->driver; |
250a78c7 | 365 | struct sr_usb_dev_inst *usb; |
dc9dbe94 | 366 | struct dev_context *devc; |
e8bd58ff UH |
367 | int ret; |
368 | int64_t timediff_us, timediff_ms; | |
43125c69 | 369 | |
dc9dbe94 | 370 | devc = sdi->priv; |
250a78c7 | 371 | usb = sdi->conn; |
43125c69 JH |
372 | |
373 | /* | |
f60fdf6e UH |
374 | * If the firmware was recently uploaded, wait up to MAX_RENUM_DELAY_MS |
375 | * milliseconds for the FX2 to renumerate. | |
43125c69 | 376 | */ |
3b6c1930 | 377 | ret = SR_ERR; |
dc9dbe94 | 378 | if (devc->fw_updated > 0) { |
f427daef | 379 | sr_info("Waiting for device to reset."); |
b99457f0 | 380 | /* Takes >= 300ms for the FX2 to be gone from the USB bus. */ |
43125c69 | 381 | g_usleep(300 * 1000); |
e8bd58ff | 382 | timediff_ms = 0; |
f60fdf6e | 383 | while (timediff_ms < MAX_RENUM_DELAY_MS) { |
2f937611 | 384 | if ((ret = fx2lafw_dev_open(sdi, di)) == SR_OK) |
43125c69 JH |
385 | break; |
386 | g_usleep(100 * 1000); | |
e8bd58ff | 387 | |
dc9dbe94 | 388 | timediff_us = g_get_monotonic_time() - devc->fw_updated; |
3b6c1930 | 389 | timediff_ms = timediff_us / 1000; |
b99457f0 | 390 | sr_spew("Waited %" PRIi64 "ms.", timediff_ms); |
43125c69 | 391 | } |
443a14d8 AG |
392 | if (ret != SR_OK) { |
393 | sr_err("Device failed to renumerate."); | |
394 | return SR_ERR; | |
395 | } | |
c0bf69c2 | 396 | sr_info("Device came back after %" PRIi64 "ms.", timediff_ms); |
43125c69 | 397 | } else { |
443a14d8 | 398 | sr_info("Firmware upload was not needed."); |
2f937611 | 399 | ret = fx2lafw_dev_open(sdi, di); |
43125c69 JH |
400 | } |
401 | ||
ebc34738 | 402 | if (ret != SR_OK) { |
f427daef | 403 | sr_err("Unable to open device."); |
43125c69 JH |
404 | return SR_ERR; |
405 | } | |
378abfea | 406 | |
250a78c7 | 407 | ret = libusb_claim_interface(usb->devhdl, USB_INTERFACE); |
ebc34738 | 408 | if (ret != 0) { |
87b545fb | 409 | switch (ret) { |
0c156e06 | 410 | case LIBUSB_ERROR_BUSY: |
f427daef | 411 | sr_err("Unable to claim USB interface. Another " |
b99457f0 | 412 | "program or driver has already claimed it."); |
0c156e06 | 413 | break; |
0c156e06 | 414 | case LIBUSB_ERROR_NO_DEVICE: |
f427daef | 415 | sr_err("Device has been disconnected."); |
0c156e06 | 416 | break; |
0c156e06 | 417 | default: |
f427daef | 418 | sr_err("Unable to claim interface: %s.", |
d4928d71 | 419 | libusb_error_name(ret)); |
0c156e06 JH |
420 | break; |
421 | } | |
422 | ||
43125c69 JH |
423 | return SR_ERR; |
424 | } | |
425 | ||
dc9dbe94 | 426 | if (devc->cur_samplerate == 0) { |
f92994fd | 427 | /* Samplerate hasn't been set; default to the slowest one. */ |
a7d7f93c | 428 | devc->cur_samplerate = devc->samplerates[0]; |
f92994fd JH |
429 | } |
430 | ||
f302a082 JH |
431 | return SR_OK; |
432 | } | |
433 | ||
6078d2c9 | 434 | static int dev_close(struct sr_dev_inst *sdi) |
f302a082 | 435 | { |
250a78c7 | 436 | struct sr_usb_dev_inst *usb; |
961009b0 | 437 | |
250a78c7 | 438 | usb = sdi->conn; |
9803346f | 439 | |
98fec29e | 440 | if (!usb->devhdl) |
25a0f108 | 441 | return SR_ERR; |
f1898235 | 442 | |
5e2c86eb SA |
443 | sr_info("fx2lafw: Closing device on %d.%d (logical) / %s (physical) interface %d.", |
444 | usb->bus, usb->address, sdi->connection_id, USB_INTERFACE); | |
250a78c7 BV |
445 | libusb_release_interface(usb->devhdl, USB_INTERFACE); |
446 | libusb_close(usb->devhdl); | |
447 | usb->devhdl = NULL; | |
25a0f108 | 448 | sdi->status = SR_ST_INACTIVE; |
f1898235 | 449 | |
f302a082 JH |
450 | return SR_OK; |
451 | } | |
452 | ||
9803346f UH |
453 | static int config_get(uint32_t key, GVariant **data, |
454 | const struct sr_dev_inst *sdi, const struct sr_channel_group *cg) | |
f302a082 | 455 | { |
dc9dbe94 | 456 | struct dev_context *devc; |
89befd46 BV |
457 | struct sr_usb_dev_inst *usb; |
458 | char str[128]; | |
8b35f474 | 459 | |
53b4680f | 460 | (void)cg; |
8f996b89 | 461 | |
a920a7d8 ML |
462 | if (!sdi) |
463 | return SR_ERR_ARG; | |
464 | ||
465 | devc = sdi->priv; | |
466 | ||
584560f1 | 467 | switch (key) { |
89befd46 | 468 | case SR_CONF_CONN: |
a920a7d8 | 469 | if (!sdi->conn) |
38ab8dbe | 470 | return SR_ERR_ARG; |
89befd46 BV |
471 | usb = sdi->conn; |
472 | if (usb->address == 255) | |
473 | /* Device still needs to re-enumerate after firmware | |
474 | * upload, so we don't know its (future) address. */ | |
475 | return SR_ERR; | |
476 | snprintf(str, 128, "%d.%d", usb->bus, usb->address); | |
477 | *data = g_variant_new_string(str); | |
478 | break; | |
a920a7d8 ML |
479 | case SR_CONF_LIMIT_SAMPLES: |
480 | *data = g_variant_new_uint64(devc->limit_samples); | |
481 | break; | |
123e1313 | 482 | case SR_CONF_SAMPLERATE: |
89befd46 | 483 | *data = g_variant_new_uint64(devc->cur_samplerate); |
6e9339aa | 484 | break; |
7bfcb25c AJ |
485 | case SR_CONF_CAPTURE_RATIO: |
486 | *data = g_variant_new_uint64(devc->capture_ratio); | |
487 | break; | |
6e9339aa | 488 | default: |
bd6fbf62 | 489 | return SR_ERR_NA; |
8b35f474 JH |
490 | } |
491 | ||
6e9339aa | 492 | return SR_OK; |
f302a082 JH |
493 | } |
494 | ||
9803346f UH |
495 | static int config_set(uint32_t key, GVariant *data, |
496 | const struct sr_dev_inst *sdi, const struct sr_channel_group *cg) | |
f302a082 | 497 | { |
dc9dbe94 | 498 | struct dev_context *devc; |
4d7b36a0 | 499 | uint64_t arg; |
65e00366 | 500 | int i, ret; |
7cb621d4 | 501 | |
53b4680f | 502 | (void)cg; |
8f996b89 | 503 | |
1c48000d ML |
504 | if (!sdi) |
505 | return SR_ERR_ARG; | |
506 | ||
e73ffd42 BV |
507 | if (sdi->status != SR_ST_ACTIVE) |
508 | return SR_ERR; | |
509 | ||
dc9dbe94 | 510 | devc = sdi->priv; |
7cb621d4 | 511 | |
1c48000d ML |
512 | ret = SR_OK; |
513 | ||
584560f1 | 514 | switch (key) { |
93b118da UH |
515 | case SR_CONF_SAMPLERATE: |
516 | arg = g_variant_get_uint64(data); | |
65e00366 CFS |
517 | for (i = 0; i < devc->num_samplerates; i++) { |
518 | if (devc->samplerates[i] == arg) { | |
93b118da UH |
519 | devc->cur_samplerate = arg; |
520 | break; | |
4d7b36a0 | 521 | } |
93b118da | 522 | } |
65e00366 | 523 | if (i == devc->num_samplerates) |
93b118da UH |
524 | ret = SR_ERR_ARG; |
525 | break; | |
526 | case SR_CONF_LIMIT_SAMPLES: | |
527 | devc->limit_samples = g_variant_get_uint64(data); | |
528 | break; | |
529 | case SR_CONF_CAPTURE_RATIO: | |
530 | devc->capture_ratio = g_variant_get_uint64(data); | |
a5c38703 | 531 | ret = (devc->capture_ratio > 100) ? SR_ERR : SR_OK; |
93b118da UH |
532 | break; |
533 | default: | |
534 | ret = SR_ERR_NA; | |
7cb621d4 JH |
535 | } |
536 | ||
537 | return ret; | |
f302a082 JH |
538 | } |
539 | ||
9803346f UH |
540 | static int config_list(uint32_t key, GVariant **data, |
541 | const struct sr_dev_inst *sdi, const struct sr_channel_group *cg) | |
a1c743fc | 542 | { |
a7d7f93c | 543 | struct dev_context *devc; |
adcb9951 | 544 | GVariant *gvar; |
d6836bf1 | 545 | GVariantBuilder gvb; |
a1c743fc | 546 | |
53b4680f | 547 | (void)cg; |
a1c743fc BV |
548 | |
549 | switch (key) { | |
89befd46 | 550 | case SR_CONF_SCAN_OPTIONS: |
584560f1 | 551 | *data = g_variant_new_fixed_array(G_VARIANT_TYPE_UINT32, |
a0e0bb41 | 552 | scanopts, ARRAY_SIZE(scanopts), sizeof(uint32_t)); |
89befd46 | 553 | break; |
9a6517d1 | 554 | case SR_CONF_DEVICE_OPTIONS: |
9803346f | 555 | if (!sdi) { |
ff6b76a1 | 556 | *data = g_variant_new_fixed_array(G_VARIANT_TYPE_UINT32, |
9803346f UH |
557 | drvopts, ARRAY_SIZE(drvopts), sizeof(uint32_t)); |
558 | } else { | |
3fc3fbe4 | 559 | devc = sdi->priv; |
adcb9951 JH |
560 | *data = g_variant_new_fixed_array(G_VARIANT_TYPE_UINT32, |
561 | devopts, ARRAY_SIZE(devopts), sizeof(uint32_t)); | |
3fc3fbe4 | 562 | } |
9a6517d1 | 563 | break; |
a1c743fc | 564 | case SR_CONF_SAMPLERATE: |
a7d7f93c | 565 | devc = sdi->priv; |
d6836bf1 | 566 | g_variant_builder_init(&gvb, G_VARIANT_TYPE("a{sv}")); |
a7d7f93c BV |
567 | gvar = g_variant_new_fixed_array(G_VARIANT_TYPE("t"), devc->samplerates, |
568 | devc->num_samplerates, sizeof(uint64_t)); | |
d6836bf1 BV |
569 | g_variant_builder_add(&gvb, "{sv}", "samplerates", gvar); |
570 | *data = g_variant_builder_end(&gvb); | |
a1c743fc | 571 | break; |
9615eeb5 BV |
572 | case SR_CONF_TRIGGER_MATCH: |
573 | *data = g_variant_new_fixed_array(G_VARIANT_TYPE_INT32, | |
574 | soft_trigger_matches, ARRAY_SIZE(soft_trigger_matches), | |
575 | sizeof(int32_t)); | |
c50277a6 | 576 | break; |
a1c743fc | 577 | default: |
bd6fbf62 | 578 | return SR_ERR_NA; |
a1c743fc BV |
579 | } |
580 | ||
581 | return SR_OK; | |
582 | } | |
583 | ||
1f9813eb | 584 | static int receive_data(int fd, int revents, void *cb_data) |
610dbb70 JH |
585 | { |
586 | struct timeval tv; | |
b99457f0 | 587 | struct drv_context *drvc; |
610dbb70 | 588 | |
610dbb70 JH |
589 | (void)fd; |
590 | (void)revents; | |
610dbb70 | 591 | |
1a863916 | 592 | drvc = (struct drv_context *)cb_data; |
b99457f0 | 593 | |
610dbb70 | 594 | tv.tv_sec = tv.tv_usec = 0; |
d4abb463 | 595 | libusb_handle_events_timeout(drvc->sr_ctx->libusb_ctx, &tv); |
610dbb70 JH |
596 | |
597 | return TRUE; | |
598 | } | |
599 | ||
b9d53092 | 600 | static int start_transfers(const struct sr_dev_inst *sdi) |
f302a082 | 601 | { |
dc9dbe94 | 602 | struct dev_context *devc; |
250a78c7 | 603 | struct sr_usb_dev_inst *usb; |
335122f0 | 604 | struct sr_trigger *trigger; |
610dbb70 | 605 | struct libusb_transfer *transfer; |
b9d53092 | 606 | unsigned int i, num_transfers; |
adcb9951 | 607 | int timeout, ret; |
610dbb70 | 608 | unsigned char *buf; |
b99457f0 | 609 | size_t size; |
610dbb70 | 610 | |
dc9dbe94 | 611 | devc = sdi->priv; |
250a78c7 | 612 | usb = sdi->conn; |
b99457f0 | 613 | |
b0ccd64d BV |
614 | devc->sent_samples = 0; |
615 | devc->acq_aborted = FALSE; | |
dc9dbe94 | 616 | devc->empty_transfer_count = 0; |
610dbb70 | 617 | |
adcb9951 | 618 | if ((trigger = sr_session_trigger_get(sdi->session))) { |
7bfcb25c AJ |
619 | int pre_trigger_samples = 0; |
620 | if (devc->limit_samples > 0) | |
621 | pre_trigger_samples = devc->capture_ratio * devc->limit_samples/100; | |
622 | devc->stl = soft_trigger_logic_new(sdi, trigger, pre_trigger_samples); | |
98fec29e | 623 | if (!devc->stl) |
7bfcb25c | 624 | return SR_ERR_MALLOC; |
9615eeb5 | 625 | devc->trigger_fired = FALSE; |
9615eeb5 BV |
626 | } else |
627 | devc->trigger_fired = TRUE; | |
628 | ||
2f937611 | 629 | num_transfers = fx2lafw_get_number_of_transfers(devc); |
a04b28ce | 630 | |
2f937611 | 631 | size = fx2lafw_get_buffer_size(devc); |
2a67abfe | 632 | devc->submitted_transfers = 0; |
5af666a9 | 633 | |
dc9dbe94 | 634 | devc->transfers = g_try_malloc0(sizeof(*devc->transfers) * num_transfers); |
886a52b6 | 635 | if (!devc->transfers) { |
f427daef | 636 | sr_err("USB transfers malloc failed."); |
886a52b6 UH |
637 | return SR_ERR_MALLOC; |
638 | } | |
0caa1ef0 | 639 | |
b9d53092 | 640 | timeout = fx2lafw_get_timeout(devc); |
dc9dbe94 | 641 | devc->num_transfers = num_transfers; |
5af666a9 | 642 | for (i = 0; i < num_transfers; i++) { |
610dbb70 | 643 | if (!(buf = g_try_malloc(size))) { |
b99457f0 | 644 | sr_err("USB transfer buffer malloc failed."); |
610dbb70 JH |
645 | return SR_ERR_MALLOC; |
646 | } | |
647 | transfer = libusb_alloc_transfer(0); | |
250a78c7 | 648 | libusb_fill_bulk_transfer(transfer, usb->devhdl, |
adcb9951 | 649 | 2 | LIBUSB_ENDPOINT_IN, buf, size, |
9615eeb5 | 650 | fx2lafw_receive_transfer, (void *)sdi, timeout); |
a04b28ce | 651 | sr_info("submitting transfer: %d", i); |
d4928d71 | 652 | if ((ret = libusb_submit_transfer(transfer)) != 0) { |
b99457f0 UH |
653 | sr_err("Failed to submit transfer: %s.", |
654 | libusb_error_name(ret)); | |
610dbb70 JH |
655 | libusb_free_transfer(transfer); |
656 | g_free(buf); | |
2f937611 | 657 | fx2lafw_abort_acquisition(devc); |
610dbb70 JH |
658 | return SR_ERR; |
659 | } | |
dc9dbe94 BV |
660 | devc->transfers[i] = transfer; |
661 | devc->submitted_transfers++; | |
610dbb70 JH |
662 | } |
663 | ||
f9592d65 UH |
664 | /* |
665 | * If this device has analog channels and at least one of them is | |
666 | * enabled, use mso_send_data_proc() to properly handle the analog | |
667 | * data. Otherwise use la_send_data_proc(). | |
668 | */ | |
669 | if (g_slist_length(devc->enabled_analog_channels) > 0) | |
7e5ccff2 JH |
670 | devc->send_data_proc = mso_send_data_proc; |
671 | else | |
672 | devc->send_data_proc = la_send_data_proc; | |
7b5d1c64 | 673 | |
bee2b016 | 674 | std_session_send_df_header(sdi); |
610dbb70 | 675 | |
b9d53092 BV |
676 | return SR_OK; |
677 | } | |
678 | ||
7fb90f94 BL |
679 | static int configure_channels(const struct sr_dev_inst *sdi) |
680 | { | |
681 | struct dev_context *devc; | |
682 | const GSList *l; | |
683 | int p; | |
684 | struct sr_channel *ch; | |
8399f68a | 685 | uint32_t channel_mask = 0, num_analog = 0; |
7fb90f94 BL |
686 | |
687 | devc = sdi->priv; | |
688 | ||
689 | g_slist_free(devc->enabled_analog_channels); | |
690 | devc->enabled_analog_channels = NULL; | |
7fb90f94 BL |
691 | |
692 | for (l = sdi->channels, p = 0; l; l = l->next, p++) { | |
693 | ch = l->data; | |
f9592d65 UH |
694 | if ((p <= NUM_CHANNELS) && (ch->type == SR_CHANNEL_ANALOG) |
695 | && (ch->enabled)) { | |
8399f68a | 696 | num_analog++; |
7fb90f94 BL |
697 | devc->enabled_analog_channels = |
698 | g_slist_append(devc->enabled_analog_channels, ch); | |
8399f68a JL |
699 | } else { |
700 | channel_mask |= ch->enabled << p; | |
7fb90f94 BL |
701 | } |
702 | } | |
703 | ||
f9592d65 | 704 | /* |
8a68f96e | 705 | * Use wide sampling if either any of the LA channels 8..15 is enabled, |
adcb9951 | 706 | * and/or at least one analog channel is enabled. |
f9592d65 | 707 | */ |
adcb9951 | 708 | devc->sample_wide = channel_mask > 0xff || num_analog > 0; |
8399f68a | 709 | |
7fb90f94 BL |
710 | return SR_OK; |
711 | } | |
712 | ||
695dc859 | 713 | static int dev_acquisition_start(const struct sr_dev_inst *sdi) |
b9d53092 | 714 | { |
4f840ce9 | 715 | struct sr_dev_driver *di; |
b9d53092 BV |
716 | struct drv_context *drvc; |
717 | struct dev_context *devc; | |
718 | int timeout, ret; | |
7e5ccff2 | 719 | size_t size; |
b9d53092 BV |
720 | |
721 | if (sdi->status != SR_ST_ACTIVE) | |
722 | return SR_ERR_DEV_CLOSED; | |
723 | ||
4f840ce9 | 724 | di = sdi->driver; |
41812aca | 725 | drvc = di->context; |
b9d53092 BV |
726 | devc = sdi->priv; |
727 | ||
b9d53092 | 728 | devc->ctx = drvc->sr_ctx; |
b9d53092 BV |
729 | devc->sent_samples = 0; |
730 | devc->empty_transfer_count = 0; | |
731 | devc->acq_aborted = FALSE; | |
732 | ||
7fb90f94 BL |
733 | if (configure_channels(sdi) != SR_OK) { |
734 | sr_err("Failed to configure channels."); | |
735 | return SR_ERR; | |
736 | } | |
737 | ||
b9d53092 | 738 | timeout = fx2lafw_get_timeout(devc); |
4f840ce9 | 739 | usb_source_add(sdi->session, devc->ctx, timeout, receive_data, drvc); |
b9d53092 | 740 | |
adcb9951 JH |
741 | size = fx2lafw_get_buffer_size(devc); |
742 | /* Prepare for analog sampling. */ | |
743 | if (g_slist_length(devc->enabled_analog_channels) > 0) { | |
744 | /* We need a buffer half the size of a transfer. */ | |
745 | devc->logic_buffer = g_try_malloc(size / 2); | |
746 | devc->analog_buffer = g_try_malloc( | |
747 | sizeof(float) * size / 2); | |
748 | } | |
749 | start_transfers(sdi); | |
750 | if ((ret = fx2lafw_command_start_acquisition(sdi)) != SR_OK) { | |
751 | fx2lafw_abort_acquisition(devc); | |
752 | return ret; | |
017375d1 JH |
753 | } |
754 | ||
f302a082 JH |
755 | return SR_OK; |
756 | } | |
757 | ||
695dc859 | 758 | static int dev_acquisition_stop(struct sr_dev_inst *sdi) |
f302a082 | 759 | { |
2f937611 | 760 | fx2lafw_abort_acquisition(sdi->priv); |
5da93902 | 761 | |
f302a082 JH |
762 | return SR_OK; |
763 | } | |
764 | ||
dd5c48a6 | 765 | static struct sr_dev_driver fx2lafw_driver_info = { |
f302a082 | 766 | .name = "fx2lafw", |
2e7cb004 | 767 | .longname = "fx2lafw (generic driver for FX2 based LAs)", |
f302a082 | 768 | .api_version = 1, |
c2fdcc25 | 769 | .init = std_init, |
700d6b64 | 770 | .cleanup = std_cleanup, |
6078d2c9 | 771 | .scan = scan, |
c01bf34c | 772 | .dev_list = std_dev_list, |
7fb90f94 | 773 | .dev_clear = dev_clear, |
035a1078 BV |
774 | .config_get = config_get, |
775 | .config_set = config_set, | |
a1c743fc | 776 | .config_list = config_list, |
6078d2c9 UH |
777 | .dev_open = dev_open, |
778 | .dev_close = dev_close, | |
779 | .dev_acquisition_start = dev_acquisition_start, | |
780 | .dev_acquisition_stop = dev_acquisition_stop, | |
41812aca | 781 | .context = NULL, |
f302a082 | 782 | }; |
dd5c48a6 | 783 | SR_REGISTER_DEV_DRIVER(fx2lafw_driver_info); |