]> sigrok.org Git - libsigrok.git/blame - hardware/hantek-dso/api.c
Return SR_ERR_MALLOC upon allocation errors.
[libsigrok.git] / hardware / hantek-dso / api.c
CommitLineData
3b533202
BV
1/*
2 * This file is part of the sigrok project.
3 *
4 * Copyright (C) 2012 Bert Vermeulen <bert@biot.com>
5 *
6 * This program is free software: you can redistribute it and/or modify
7 * it under the terms of the GNU General Public License as published by
8 * the Free Software Foundation, either version 3 of the License, or
9 * (at your option) any later version.
10 *
11 * This program is distributed in the hope that it will be useful,
12 * but WITHOUT ANY WARRANTY; without even the implied warranty of
13 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
14 * GNU General Public License for more details.
15 *
16 * You should have received a copy of the GNU General Public License
17 * along with this program. If not, see <http://www.gnu.org/licenses/>.
18 */
19
20#include <stdio.h>
21#include <stdint.h>
22#include <stdlib.h>
23#include <sys/types.h>
24#include <sys/stat.h>
25#include <fcntl.h>
26#include <unistd.h>
27#include <string.h>
28#include <sys/time.h>
29#include <inttypes.h>
3b533202
BV
30#include <glib.h>
31#include <libusb.h>
45c59c8b
BV
32#include "libsigrok.h"
33#include "libsigrok-internal.h"
3b533202
BV
34#include "dso.h"
35
36
fc8fe3e3
BV
37/* Max time in ms before we want to check on USB events */
38/* TODO tune this properly */
3b533202
BV
39#define TICK 1
40
62bb8840 41static const int hwcaps[] = {
3b533202 42 SR_HWCAP_OSCILLOSCOPE,
ae88b97b 43 SR_HWCAP_LIMIT_SAMPLES,
3b533202 44 SR_HWCAP_CONTINUOUS,
a370ef19
BV
45 SR_HWCAP_TIMEBASE,
46 SR_HWCAP_BUFFERSIZE,
47 SR_HWCAP_TRIGGER_SOURCE,
48 SR_HWCAP_TRIGGER_SLOPE,
49 SR_HWCAP_HORIZ_TRIGGERPOS,
ebb781a6 50 SR_HWCAP_FILTER,
313deed2 51 SR_HWCAP_VDIV,
4a090d72 52 SR_HWCAP_COUPLING,
3b533202
BV
53 0,
54};
55
56static const char *probe_names[] = {
57 "CH1",
58 "CH2",
59 NULL,
60};
61
62bb8840 62static const struct dso_profile dev_profiles[] = {
88a13f30 63 { 0x04b4, 0x2090, 0x04b5, 0x2090,
3b533202 64 "Hantek", "DSO-2090",
88a13f30
BV
65 FIRMWARE_DIR "/hantek-dso-2xxx.fw" },
66 { 0x04b4, 0x2150, 0x04b5, 0x2150,
67 "Hantek", "DSO-2150",
68 FIRMWARE_DIR "/hantek-dso-2xxx.fw" },
69 { 0x04b4, 0x2250, 0x04b5, 0x2250,
70 "Hantek", "DSO-2250",
71 FIRMWARE_DIR "/hantek-dso-2xxx.fw" },
72 { 0x04b4, 0x5200, 0x04b5, 0x5200,
73 "Hantek", "DSO-5200",
74 FIRMWARE_DIR "/hantek-dso-5xxx.fw" },
75 { 0x04b4, 0x520a, 0x04b5, 0x520a,
76 "Hantek", "DSO-5200A",
77 FIRMWARE_DIR "/hantek-dso-5xxx.fw" },
78 { 0, 0, 0, 0, 0, 0, 0 },
3b533202
BV
79};
80
62bb8840 81static const uint64_t buffersizes[] = {
a370ef19
BV
82 10240,
83 32768,
84 /* TODO: 65535 */
62bb8840 85 0,
a370ef19
BV
86};
87
62bb8840 88static const struct sr_rational timebases[] = {
a370ef19
BV
89 /* microseconds */
90 { 10, 1000000 },
91 { 20, 1000000 },
92 { 40, 1000000 },
93 { 100, 1000000 },
94 { 200, 1000000 },
95 { 400, 1000000 },
96 /* milliseconds */
97 { 1, 1000 },
98 { 2, 1000 },
99 { 4, 1000 },
100 { 10, 1000 },
101 { 20, 1000 },
102 { 40, 1000 },
103 { 100, 1000 },
104 { 200, 1000 },
105 { 400, 1000 },
62bb8840 106 { 0, 0},
a370ef19
BV
107};
108
62bb8840 109static const struct sr_rational vdivs[] = {
313deed2
BV
110 /* millivolts */
111 { 10, 1000 },
112 { 20, 1000 },
113 { 50, 1000 },
114 { 100, 1000 },
115 { 200, 1000 },
116 { 500, 1000 },
117 /* volts */
118 { 1, 1 },
119 { 2, 1 },
120 { 5, 1 },
62bb8840 121 { 0, 0 },
313deed2
BV
122};
123
62bb8840 124static const char *trigger_sources[] = {
a370ef19
BV
125 "CH1",
126 "CH2",
127 "EXT",
88a13f30 128 /* TODO: forced */
62bb8840 129 NULL,
a370ef19 130};
3b533202 131
62bb8840 132static const char *filter_targets[] = {
ebb781a6
BV
133 "CH1",
134 "CH2",
135 /* TODO: "TRIGGER", */
62bb8840 136 NULL,
ebb781a6
BV
137};
138
62bb8840 139static const char *coupling[] = {
b58fbd99
BV
140 "AC",
141 "DC",
142 "GND",
62bb8840 143 NULL,
b58fbd99
BV
144};
145
982947f7
BV
146SR_PRIV struct sr_dev_driver hantek_dso_driver_info;
147static struct sr_dev_driver *hdi = &hantek_dso_driver_info;
269971dd
BV
148static int hw_dev_acquisition_stop(const struct sr_dev_inst *sdi,
149 void *cb_data);
3b533202 150
62bb8840 151static struct sr_dev_inst *dso_dev_new(int index, const struct dso_profile *prof)
3b533202
BV
152{
153 struct sr_dev_inst *sdi;
87ca93c5 154 struct sr_probe *probe;
269971dd
BV
155 struct drv_context *drvc;
156 struct dev_context *devc;
87ca93c5 157 int i;
3b533202
BV
158
159 sdi = sr_dev_inst_new(index, SR_ST_INITIALIZING,
88a13f30 160 prof->vendor, prof->model, NULL);
3b533202
BV
161 if (!sdi)
162 return NULL;
b0c8d7ac 163 sdi->driver = hdi;
3b533202 164
87ca93c5
BV
165 /* Add only the real probes -- EXT isn't a source of data, only
166 * a trigger source internal to the device.
167 */
168 for (i = 0; probe_names[i]; i++) {
169 if (!(probe = sr_probe_new(i, SR_PROBE_ANALOG, TRUE,
170 probe_names[i])))
171 return NULL;
172 sdi->probes = g_slist_append(sdi->probes, probe);
173 }
174
269971dd
BV
175 if (!(devc = g_try_malloc0(sizeof(struct dev_context)))) {
176 sr_err("hantek-dso: devc malloc failed");
3b533202
BV
177 return NULL;
178 }
269971dd
BV
179 devc->profile = prof;
180 devc->dev_state = IDLE;
181 devc->timebase = DEFAULT_TIMEBASE;
182 devc->ch1_enabled = TRUE;
183 devc->ch2_enabled = TRUE;
184 devc->voltage_ch1 = DEFAULT_VOLTAGE;
185 devc->voltage_ch2 = DEFAULT_VOLTAGE;
186 devc->coupling_ch1 = DEFAULT_COUPLING;
187 devc->coupling_ch2 = DEFAULT_COUPLING;
188 devc->voffset_ch1 = DEFAULT_VERT_OFFSET;
189 devc->voffset_ch2 = DEFAULT_VERT_OFFSET;
190 devc->voffset_trigger = DEFAULT_VERT_TRIGGERPOS;
191 devc->framesize = DEFAULT_FRAMESIZE;
192 devc->triggerslope = SLOPE_POSITIVE;
193 devc->triggersource = g_strdup(DEFAULT_TRIGGER_SOURCE);
194 devc->triggerposition = DEFAULT_HORIZ_TRIGGERPOS;
195 sdi->priv = devc;
196 drvc = hdi->priv;
197 drvc->instances = g_slist_append(drvc->instances, sdi);
3b533202
BV
198
199 return sdi;
200}
201
014359e3 202static int configure_probes(const struct sr_dev_inst *sdi)
3b533202 203{
014359e3 204 struct dev_context *devc;
62bb8840
UH
205 const struct sr_probe *probe;
206 const GSList *l;
3b533202 207
014359e3
BV
208 devc = sdi->priv;
209
269971dd 210 devc->ch1_enabled = devc->ch2_enabled = FALSE;
014359e3 211 for (l = sdi->probes; l; l = l->next) {
3b533202 212 probe = (struct sr_probe *)l->data;
b35c8293 213 if (probe->index == 0)
269971dd 214 devc->ch1_enabled = probe->enabled;
b35c8293 215 else if (probe->index == 1)
269971dd 216 devc->ch2_enabled = probe->enabled;
3b533202
BV
217 }
218
219 return SR_OK;
220}
221
39cfdd75 222/* Properly close and free all devices. */
811deee4 223static int clear_instances(void)
39cfdd75
BV
224{
225 struct sr_dev_inst *sdi;
269971dd
BV
226 struct drv_context *drvc;
227 struct dev_context *devc;
39cfdd75
BV
228 GSList *l;
229
269971dd
BV
230 drvc = hdi->priv;
231 for (l = drvc->instances; l; l = l->next) {
39cfdd75
BV
232 if (!(sdi = l->data)) {
233 /* Log error, but continue cleaning up the rest. */
234 sr_err("hantek-dso: %s: sdi was NULL, continuing", __func__);
235 continue;
236 }
269971dd 237 if (!(devc = sdi->priv)) {
39cfdd75
BV
238 /* Log error, but continue cleaning up the rest. */
239 sr_err("hantek-dso: %s: sdi->priv was NULL, continuing", __func__);
240 continue;
241 }
242 dso_close(sdi);
269971dd
BV
243 sr_usb_dev_inst_free(devc->usb);
244 g_free(devc->triggersource);
39cfdd75
BV
245
246 sr_dev_inst_free(sdi);
247 }
248
269971dd
BV
249 g_slist_free(drvc->instances);
250 drvc->instances = NULL;
39cfdd75 251
811deee4 252 return SR_OK;
39cfdd75
BV
253}
254
40dda2c3 255static int hw_init(void)
61136ea6 256{
269971dd
BV
257 struct drv_context *drvc;
258
259 if (!(drvc = g_try_malloc0(sizeof(struct drv_context)))) {
260 sr_err("hantek-dso: driver context malloc failed.");
886a52b6 261 return SR_ERR_MALLOC;
269971dd 262 }
61136ea6 263
19b0cce3 264 if (libusb_init(NULL) != 0) {
269971dd 265 g_free(drvc);
61136ea6
BV
266 sr_err("hantek-dso: Failed to initialize USB.");
267 return SR_ERR;
268 }
269
269971dd
BV
270 hdi->priv = drvc;
271
61136ea6
BV
272 return SR_OK;
273}
274
39cfdd75 275static GSList *hw_scan(GSList *options)
3b533202
BV
276{
277 struct sr_dev_inst *sdi;
62bb8840 278 const struct dso_profile *prof;
269971dd
BV
279 struct drv_context *drvc;
280 struct dev_context *devc;
39cfdd75
BV
281 GSList *devices;
282 struct libusb_device_descriptor des;
3b533202 283 libusb_device **devlist;
61136ea6 284 int devcnt, ret, i, j;
3b533202 285
39cfdd75 286 (void)options;
3b533202 287 devcnt = 0;
39cfdd75 288 devices = 0;
269971dd
BV
289 drvc = hdi->priv;
290 drvc->instances = NULL;
39cfdd75
BV
291
292 clear_instances();
293
294 /* Find all Hantek DSO devices and upload firmware to all of them. */
19b0cce3 295 libusb_get_device_list(NULL, &devlist);
3b533202 296 for (i = 0; devlist[i]; i++) {
61136ea6
BV
297 if ((ret = libusb_get_device_descriptor(devlist[i], &des))) {
298 sr_err("hantek-dso: failed to get device descriptor: %d", ret);
3b533202
BV
299 continue;
300 }
301
302 prof = NULL;
303 for (j = 0; dev_profiles[j].orig_vid; j++) {
304 if (des.idVendor == dev_profiles[j].orig_vid
305 && des.idProduct == dev_profiles[j].orig_pid) {
306 /* Device matches the pre-firmware profile. */
307 prof = &dev_profiles[j];
308 sr_dbg("hantek-dso: Found a %s %s.", prof->vendor, prof->model);
309 sdi = dso_dev_new(devcnt, prof);
39cfdd75 310 devices = g_slist_append(devices, sdi);
269971dd 311 devc = sdi->priv;
3b533202
BV
312 if (ezusb_upload_firmware(devlist[i], USB_CONFIGURATION,
313 prof->firmware) == SR_OK)
314 /* Remember when the firmware on this device was updated */
269971dd 315 devc->fw_updated = g_get_monotonic_time();
3b533202
BV
316 else
317 sr_err("hantek-dso: firmware upload failed for "
318 "device %d", devcnt);
319 /* Dummy USB address of 0xff will get overwritten later. */
269971dd 320 devc->usb = sr_usb_dev_inst_new(
3b533202
BV
321 libusb_get_bus_number(devlist[i]), 0xff, NULL);
322 devcnt++;
323 break;
324 } else if (des.idVendor == dev_profiles[j].fw_vid
325 && des.idProduct == dev_profiles[j].fw_pid) {
326 /* Device matches the post-firmware profile. */
327 prof = &dev_profiles[j];
328 sr_dbg("hantek-dso: Found a %s %s.", prof->vendor, prof->model);
329 sdi = dso_dev_new(devcnt, prof);
330 sdi->status = SR_ST_INACTIVE;
39cfdd75 331 devices = g_slist_append(devices, sdi);
269971dd
BV
332 devc = sdi->priv;
333 devc->usb = sr_usb_dev_inst_new(
3b533202
BV
334 libusb_get_bus_number(devlist[i]),
335 libusb_get_device_address(devlist[i]), NULL);
336 devcnt++;
337 break;
338 }
339 }
340 if (!prof)
341 /* not a supported VID/PID */
342 continue;
343 }
344 libusb_free_device_list(devlist, 1);
345
39cfdd75 346 return devices;
3b533202
BV
347}
348
811deee4
BV
349static GSList *hw_dev_list(void)
350{
351 struct drv_context *drvc;
352
353 drvc = hdi->priv;
354
355 return drvc->instances;
356}
357
25a0f108 358static int hw_dev_open(struct sr_dev_inst *sdi)
3b533202 359{
269971dd 360 struct dev_context *devc;
fc8fe3e3
BV
361 int64_t timediff_us, timediff_ms;
362 int err;
3b533202 363
269971dd 364 devc = sdi->priv;
3b533202
BV
365
366 /*
fc8fe3e3 367 * if the firmware was recently uploaded, wait up to MAX_RENUM_DELAY_MS
3b533202
BV
368 * for the FX2 to renumerate
369 */
fc8fe3e3 370 err = SR_ERR;
269971dd 371 if (devc->fw_updated > 0) {
3b533202
BV
372 sr_info("hantek-dso: waiting for device to reset");
373 /* takes at least 300ms for the FX2 to be gone from the USB bus */
374 g_usleep(300 * 1000);
fc8fe3e3
BV
375 timediff_ms = 0;
376 while (timediff_ms < MAX_RENUM_DELAY_MS) {
25a0f108 377 if ((err = dso_open(sdi)) == SR_OK)
3b533202
BV
378 break;
379 g_usleep(100 * 1000);
269971dd 380 timediff_us = g_get_monotonic_time() - devc->fw_updated;
fc8fe3e3 381 timediff_ms = timediff_us / 1000;
99f5d45e 382 sr_spew("hantek-dso: waited %" PRIi64 " ms", timediff_ms);
3b533202 383 }
fc8fe3e3 384 sr_info("hantek-dso: device came back after %d ms", timediff_ms);
3b533202 385 } else {
25a0f108 386 err = dso_open(sdi);
3b533202
BV
387 }
388
389 if (err != SR_OK) {
390 sr_err("hantek-dso: unable to open device");
391 return SR_ERR;
392 }
393
269971dd 394 err = libusb_claim_interface(devc->usb->devhdl, USB_INTERFACE);
3b533202
BV
395 if (err != 0) {
396 sr_err("hantek-dso: Unable to claim interface: %d", err);
397 return SR_ERR;
398 }
399
400 return SR_OK;
401}
402
25a0f108 403static int hw_dev_close(struct sr_dev_inst *sdi)
3b533202 404{
3b533202
BV
405
406 dso_close(sdi);
407
408 return SR_OK;
409}
410
411static int hw_cleanup(void)
412{
269971dd
BV
413 struct drv_context *drvc;
414
415 if (!(drvc = hdi->priv))
416 return SR_OK;
3b533202 417
39cfdd75 418 clear_instances();
3b533202 419
19b0cce3 420 libusb_exit(NULL);
3b533202
BV
421
422 return SR_OK;
423}
424
0b79bcbb
BV
425static int hw_info_get(int info_id, const void **data,
426 const struct sr_dev_inst *sdi)
3b533202 427{
3b533202
BV
428 uint64_t tmp;
429
6f57fd96
BV
430 (void)sdi;
431
0b79bcbb 432 switch (info_id) {
2ce9f046
BV
433 case SR_DI_HWCAPS:
434 *data = hwcaps;
435 break;
3b533202 436 case SR_DI_NUM_PROBES:
0b79bcbb 437 *data = GINT_TO_POINTER(NUM_PROBES);
3b533202
BV
438 break;
439 case SR_DI_PROBE_NAMES:
0b79bcbb 440 *data = probe_names;
3b533202 441 break;
a370ef19 442 case SR_DI_BUFFERSIZES:
0b79bcbb 443 *data = buffersizes;
a370ef19
BV
444 break;
445 case SR_DI_TIMEBASES:
0b79bcbb 446 *data = timebases;
a370ef19
BV
447 break;
448 case SR_DI_TRIGGER_SOURCES:
0b79bcbb 449 *data = trigger_sources;
a370ef19 450 break;
ebb781a6 451 case SR_DI_FILTERS:
0b79bcbb 452 *data = filter_targets;
ebb781a6 453 break;
313deed2 454 case SR_DI_VDIVS:
0b79bcbb 455 *data = vdivs;
313deed2 456 break;
4a090d72 457 case SR_DI_COUPLING:
0b79bcbb 458 *data = coupling;
4a090d72 459 break;
3b533202
BV
460 /* TODO remove this */
461 case SR_DI_CUR_SAMPLERATE:
0b79bcbb 462 *data = &tmp;
3b533202 463 break;
b0c8d7ac
BV
464 default:
465 return SR_ERR_ARG;
3b533202
BV
466 }
467
0b79bcbb 468 return SR_OK;
3b533202
BV
469}
470
6f4b1868
BV
471static int hw_dev_config_set(const struct sr_dev_inst *sdi, int hwcap,
472 const void *value)
3b533202 473{
269971dd 474 struct dev_context *devc;
a370ef19
BV
475 struct sr_rational tmp_rat;
476 float tmp_float;
477 uint64_t tmp_u64;
478 int ret, i;
4a090d72 479 char **targets;
3b533202 480
3b533202
BV
481 if (sdi->status != SR_ST_ACTIVE)
482 return SR_ERR;
483
a370ef19 484 ret = SR_OK;
269971dd 485 devc = sdi->priv;
3b533202 486 switch (hwcap) {
ae88b97b 487 case SR_HWCAP_LIMIT_FRAMES:
269971dd 488 devc->limit_frames = *(const uint64_t *)value;
ae88b97b 489 break;
a370ef19 490 case SR_HWCAP_TRIGGER_SLOPE:
62bb8840 491 tmp_u64 = *(const int *)value;
a370ef19
BV
492 if (tmp_u64 != SLOPE_NEGATIVE && tmp_u64 != SLOPE_POSITIVE)
493 ret = SR_ERR_ARG;
269971dd 494 devc->triggerslope = tmp_u64;
a370ef19
BV
495 break;
496 case SR_HWCAP_HORIZ_TRIGGERPOS:
62bb8840 497 tmp_float = *(const float *)value;
a370ef19
BV
498 if (tmp_float < 0.0 || tmp_float > 1.0) {
499 sr_err("hantek-dso: trigger position should be between 0.0 and 1.0");
3b533202 500 ret = SR_ERR_ARG;
a370ef19 501 } else
269971dd 502 devc->triggerposition = tmp_float;
a370ef19
BV
503 break;
504 case SR_HWCAP_BUFFERSIZE:
62bb8840 505 tmp_u64 = *(const int *)value;
a370ef19
BV
506 for (i = 0; buffersizes[i]; i++) {
507 if (buffersizes[i] == tmp_u64) {
269971dd 508 devc->framesize = tmp_u64;
a370ef19
BV
509 break;
510 }
511 }
512 if (buffersizes[i] == 0)
513 ret = SR_ERR_ARG;
514 break;
515 case SR_HWCAP_TIMEBASE:
62bb8840 516 tmp_rat = *(const struct sr_rational *)value;
a370ef19
BV
517 for (i = 0; timebases[i].p && timebases[i].q; i++) {
518 if (timebases[i].p == tmp_rat.p
519 && timebases[i].q == tmp_rat.q) {
269971dd 520 devc->timebase = i;
a370ef19
BV
521 break;
522 }
523 }
524 if (timebases[i].p == 0 && timebases[i].q == 0)
525 ret = SR_ERR_ARG;
526 break;
527 case SR_HWCAP_TRIGGER_SOURCE:
a370ef19 528 for (i = 0; trigger_sources[i]; i++) {
4a090d72 529 if (!strcmp(value, trigger_sources[i])) {
269971dd 530 devc->triggersource = g_strdup(value);
a370ef19
BV
531 break;
532 }
533 }
534 if (trigger_sources[i] == 0)
535 ret = SR_ERR_ARG;
536 break;
ebb781a6 537 case SR_HWCAP_FILTER:
269971dd 538 devc->filter_ch1 = devc->filter_ch2 = devc->filter_trigger = 0;
ebb781a6
BV
539 targets = g_strsplit(value, ",", 0);
540 for (i = 0; targets[i]; i++) {
541 if (targets[i] == '\0')
542 /* Empty filter string can be used to clear them all. */
543 ;
544 else if (!strcmp(targets[i], "CH1"))
269971dd 545 devc->filter_ch1 = TRUE;
ebb781a6 546 else if (!strcmp(targets[i], "CH2"))
269971dd 547 devc->filter_ch2 = TRUE;
ebb781a6 548 else if (!strcmp(targets[i], "TRIGGER"))
269971dd 549 devc->filter_trigger = TRUE;
ebb781a6
BV
550 else {
551 sr_err("invalid filter target %s", targets[i]);
552 ret = SR_ERR_ARG;
553 }
554 }
555 g_strfreev(targets);
556 break;
313deed2
BV
557 case SR_HWCAP_VDIV:
558 /* TODO not supporting vdiv per channel yet */
62bb8840 559 tmp_rat = *(const struct sr_rational *)value;
313deed2
BV
560 for (i = 0; vdivs[i].p && vdivs[i].q; i++) {
561 if (vdivs[i].p == tmp_rat.p
562 && vdivs[i].q == tmp_rat.q) {
269971dd
BV
563 devc->voltage_ch1 = i;
564 devc->voltage_ch2 = i;
313deed2
BV
565 break;
566 }
567 }
568 if (vdivs[i].p == 0 && vdivs[i].q == 0)
569 ret = SR_ERR_ARG;
570 break;
b58fbd99
BV
571 case SR_HWCAP_COUPLING:
572 /* TODO not supporting coupling per channel yet */
b58fbd99 573 for (i = 0; coupling[i]; i++) {
4a090d72 574 if (!strcmp(value, coupling[i])) {
269971dd
BV
575 devc->coupling_ch1 = i;
576 devc->coupling_ch2 = i;
b58fbd99
BV
577 break;
578 }
579 }
580 if (coupling[i] == 0)
581 ret = SR_ERR_ARG;
582 break;
3b533202
BV
583 default:
584 ret = SR_ERR_ARG;
585 }
586
587 return ret;
588}
589
269971dd 590static void send_chunk(struct dev_context *devc, unsigned char *buf,
e749a8cb 591 int num_samples)
3b533202
BV
592{
593 struct sr_datafeed_packet packet;
594 struct sr_datafeed_analog analog;
c5841b28 595 float ch1, ch2, range;
6e71ef3b 596 int num_probes, data_offset, i;
3b533202 597
269971dd 598 num_probes = (devc->ch1_enabled && devc->ch2_enabled) ? 2 : 1;
3b533202
BV
599 packet.type = SR_DF_ANALOG;
600 packet.payload = &analog;
6e71ef3b 601 /* TODO: support for 5xxx series 9-bit samples */
e749a8cb 602 analog.num_samples = num_samples;
9956f285
UH
603 analog.mq = SR_MQ_VOLTAGE;
604 analog.unit = SR_UNIT_VOLT;
886a52b6 605 /* TODO: Check malloc return value. */
6e71ef3b
BV
606 analog.data = g_try_malloc(analog.num_samples * sizeof(float) * num_probes);
607 data_offset = 0;
3b533202 608 for (i = 0; i < analog.num_samples; i++) {
6e71ef3b
BV
609 /* The device always sends data for both channels. If a channel
610 * is disabled, it contains a copy of the enabled channel's
611 * data. However, we only send the requested channels to the bus.
c5841b28
BV
612 *
613 * Voltage values are encoded as a value 0-255 (0-512 on the 5200*),
614 * where the value is a point in the range represented by the vdiv
615 * setting. There are 8 vertical divs, so e.g. 500mV/div represents
616 * 4V peak-to-peak where 0 = -2V and 255 = +2V.
6e71ef3b 617 */
3b533202 618 /* TODO: support for 5xxx series 9-bit samples */
269971dd
BV
619 if (devc->ch1_enabled) {
620 range = ((float)vdivs[devc->voltage_ch1].p / vdivs[devc->voltage_ch1].q) * 8;
e749a8cb 621 ch1 = range / 255 * *(buf + i * 2 + 1);
c5841b28
BV
622 /* Value is centered around 0V. */
623 ch1 -= range / 2;
6e71ef3b
BV
624 analog.data[data_offset++] = ch1;
625 }
269971dd
BV
626 if (devc->ch2_enabled) {
627 range = ((float)vdivs[devc->voltage_ch2].p / vdivs[devc->voltage_ch2].q) * 8;
e749a8cb 628 ch2 = range / 255 * *(buf + i * 2);
c5841b28 629 ch2 -= range / 2;
6e71ef3b
BV
630 analog.data[data_offset++] = ch2;
631 }
3b533202 632 }
269971dd 633 sr_session_send(devc->cb_data, &packet);
e749a8cb
BV
634
635}
636
637/* Called by libusb (as triggered by handle_event()) when a transfer comes in.
638 * Only channel data comes in asynchronously, and all transfers for this are
639 * queued up beforehand, so this just needs so chuck the incoming data onto
640 * the libsigrok session bus.
641 */
642static void receive_transfer(struct libusb_transfer *transfer)
643{
644 struct sr_datafeed_packet packet;
269971dd 645 struct dev_context *devc;
e749a8cb
BV
646 int num_samples, pre;
647
269971dd 648 devc = transfer->user_data;
e749a8cb
BV
649 sr_dbg("hantek-dso: receive_transfer(): status %d received %d bytes",
650 transfer->status, transfer->actual_length);
651
652 if (transfer->actual_length == 0)
653 /* Nothing to send to the bus. */
654 return;
655
656 num_samples = transfer->actual_length / 2;
657
269971dd
BV
658 sr_dbg("hantek-dso: got %d-%d/%d samples in frame", devc->samp_received + 1,
659 devc->samp_received + num_samples, devc->framesize);
e749a8cb
BV
660
661 /* The device always sends a full frame, but the beginning of the frame
662 * doesn't represent the trigger point. The offset at which the trigger
663 * happened came in with the capture state, so we need to start sending
664 * from there up the session bus. The samples in the frame buffer before
665 * that trigger point came after the end of the device's frame buffer was
666 * reached, and it wrapped around to overwrite up until the trigger point.
667 */
269971dd 668 if (devc->samp_received < devc->trigger_offset) {
e749a8cb 669 /* Trigger point not yet reached. */
269971dd 670 if (devc->samp_received + num_samples < devc->trigger_offset) {
e749a8cb 671 /* The entire chunk is before the trigger point. */
269971dd 672 memcpy(devc->framebuf + devc->samp_buffered * 2,
e749a8cb 673 transfer->buffer, num_samples * 2);
269971dd 674 devc->samp_buffered += num_samples;
e749a8cb
BV
675 } else {
676 /* This chunk hits or overruns the trigger point.
677 * Store the part before the trigger fired, and
678 * send the rest up to the session bus. */
269971dd
BV
679 pre = devc->trigger_offset - devc->samp_received;
680 memcpy(devc->framebuf + devc->samp_buffered * 2,
e749a8cb 681 transfer->buffer, pre * 2);
269971dd 682 devc->samp_buffered += pre;
e749a8cb
BV
683
684 /* The rest of this chunk starts with the trigger point. */
685 sr_dbg("hantek-dso: reached trigger point, %d samples buffered",
269971dd 686 devc->samp_buffered);
e749a8cb
BV
687
688 /* Avoid the corner case where the chunk ended at
689 * exactly the trigger point. */
690 if (num_samples > pre)
269971dd 691 send_chunk(devc, transfer->buffer + pre * 2,
e749a8cb
BV
692 num_samples - pre);
693 }
694 } else {
695 /* Already past the trigger point, just send it all out. */
269971dd 696 send_chunk(devc, transfer->buffer,
e749a8cb
BV
697 num_samples);
698 }
699
269971dd 700 devc->samp_received += num_samples;
e749a8cb
BV
701
702 /* Everything in this transfer was either copied to the buffer or
703 * sent to the session bus. */
3b533202
BV
704 g_free(transfer->buffer);
705 libusb_free_transfer(transfer);
3b533202 706
269971dd 707 if (devc->samp_received >= devc->framesize) {
e749a8cb
BV
708 /* That was the last chunk in this frame. Send the buffered
709 * pre-trigger samples out now, in one big chunk. */
710 sr_dbg("hantek-dso: end of frame, sending %d pre-trigger buffered samples",
269971dd
BV
711 devc->samp_buffered);
712 send_chunk(devc, devc->framebuf, devc->samp_buffered);
e749a8cb
BV
713
714 /* Mark the end of this frame. */
ae88b97b 715 packet.type = SR_DF_FRAME_END;
269971dd 716 sr_session_send(devc->cb_data, &packet);
ae88b97b 717
269971dd 718 if (devc->limit_frames && ++devc->num_frames == devc->limit_frames) {
ae88b97b 719 /* Terminate session */
a3508e33 720 devc->dev_state = STOPPING;
ae88b97b 721 } else {
269971dd 722 devc->dev_state = NEW_CAPTURE;
ae88b97b
BV
723 }
724 }
725
3b533202
BV
726}
727
728static int handle_event(int fd, int revents, void *cb_data)
729{
a3508e33 730 const struct sr_dev_inst *sdi;
ae88b97b 731 struct sr_datafeed_packet packet;
3b533202 732 struct timeval tv;
269971dd 733 struct dev_context *devc;
a3508e33
BV
734 const struct libusb_pollfd **lupfd;
735 int num_probes, i;
6e6eeff4
BV
736 uint32_t trigger_offset;
737 uint8_t capturestate;
3b533202
BV
738
739 /* Avoid compiler warnings. */
740 (void)fd;
741 (void)revents;
742
269971dd
BV
743 sdi = cb_data;
744 devc = sdi->priv;
a3508e33
BV
745 if (devc->dev_state == STOPPING) {
746 /* We've been told to wind up the acquisition. */
747 sr_dbg("hantek-dso: stopping acquisition");
748 /* TODO: doesn't really cancel pending transfers so they might
749 * come in after SR_DF_END is sent. */
19b0cce3 750 lupfd = libusb_get_pollfds(NULL);
a3508e33
BV
751 for (i = 0; lupfd[i]; i++)
752 sr_source_remove(lupfd[i]->fd);
753 free(lupfd);
754
755 packet.type = SR_DF_END;
756 sr_session_send(sdi, &packet);
757
758 devc->dev_state = IDLE;
759
760 return TRUE;
761 }
762
3b533202
BV
763 /* Always handle pending libusb events. */
764 tv.tv_sec = tv.tv_usec = 0;
19b0cce3 765 libusb_handle_events_timeout(NULL, &tv);
3b533202 766
3b533202 767 /* TODO: ugh */
269971dd
BV
768 if (devc->dev_state == NEW_CAPTURE) {
769 if (dso_capture_start(devc) != SR_OK)
3b533202 770 return TRUE;
269971dd 771 if (dso_enable_trigger(devc) != SR_OK)
3b533202 772 return TRUE;
269971dd 773// if (dso_force_trigger(devc) != SR_OK)
a370ef19 774// return TRUE;
3b533202 775 sr_dbg("hantek-dso: successfully requested next chunk");
269971dd 776 devc->dev_state = CAPTURE;
3b533202
BV
777 return TRUE;
778 }
269971dd 779 if (devc->dev_state != CAPTURE)
3b533202
BV
780 return TRUE;
781
269971dd 782 if ((dso_get_capturestate(devc, &capturestate, &trigger_offset)) != SR_OK)
3b533202 783 return TRUE;
3b533202
BV
784
785 sr_dbg("hantek-dso: capturestate %d", capturestate);
6e6eeff4 786 sr_dbg("hantek-dso: trigger offset 0x%.6x", trigger_offset);
3b533202
BV
787 switch (capturestate) {
788 case CAPTURE_EMPTY:
269971dd
BV
789 if (++devc->capture_empty_count >= MAX_CAPTURE_EMPTY) {
790 devc->capture_empty_count = 0;
791 if (dso_capture_start(devc) != SR_OK)
3b533202 792 break;
269971dd 793 if (dso_enable_trigger(devc) != SR_OK)
3b533202 794 break;
269971dd 795// if (dso_force_trigger(devc) != SR_OK)
a370ef19 796// break;
3b533202
BV
797 sr_dbg("hantek-dso: successfully requested next chunk");
798 }
799 break;
800 case CAPTURE_FILLING:
801 /* no data yet */
802 break;
803 case CAPTURE_READY_8BIT:
e749a8cb 804 /* Remember where in the captured frame the trigger is. */
269971dd 805 devc->trigger_offset = trigger_offset;
e749a8cb 806
269971dd 807 num_probes = (devc->ch1_enabled && devc->ch2_enabled) ? 2 : 1;
886a52b6 808 /* TODO: Check malloc return value. */
269971dd
BV
809 devc->framebuf = g_try_malloc(devc->framesize * num_probes * 2);
810 devc->samp_buffered = devc->samp_received = 0;
e749a8cb 811
3b533202 812 /* Tell the scope to send us the first frame. */
269971dd 813 if (dso_get_channeldata(devc, receive_transfer) != SR_OK)
3b533202 814 break;
ae88b97b
BV
815
816 /* Don't hit the state machine again until we're done fetching
817 * the data we just told the scope to send.
818 */
269971dd 819 devc->dev_state = FETCH_DATA;
ae88b97b
BV
820
821 /* Tell the frontend a new frame is on the way. */
822 packet.type = SR_DF_FRAME_BEGIN;
269971dd 823 sr_session_send(sdi, &packet);
3b533202
BV
824 break;
825 case CAPTURE_READY_9BIT:
826 /* TODO */
827 sr_err("not yet supported");
828 break;
829 case CAPTURE_TIMEOUT:
830 /* Doesn't matter, we'll try again next time. */
831 break;
832 default:
833 sr_dbg("unknown capture state");
834 }
835
836 return TRUE;
837}
838
3ffb6964
BV
839static int hw_dev_acquisition_start(const struct sr_dev_inst *sdi,
840 void *cb_data)
3b533202
BV
841{
842 const struct libusb_pollfd **lupfd;
843 struct sr_datafeed_packet packet;
844 struct sr_datafeed_header header;
845 struct sr_datafeed_meta_analog meta;
269971dd 846 struct dev_context *devc;
3b533202
BV
847 int i;
848
3b533202
BV
849 if (sdi->status != SR_ST_ACTIVE)
850 return SR_ERR;
851
269971dd
BV
852 devc = sdi->priv;
853 devc->cb_data = cb_data;
3b533202 854
014359e3
BV
855 if (configure_probes(sdi) != SR_OK) {
856 sr_err("hantek-dso: failed to configured probes");
857 return SR_ERR;
858 }
859
269971dd 860 if (dso_init(devc) != SR_OK)
3b533202
BV
861 return SR_ERR;
862
269971dd 863 if (dso_capture_start(devc) != SR_OK)
3b533202
BV
864 return SR_ERR;
865
269971dd 866 devc->dev_state = CAPTURE;
19b0cce3 867 lupfd = libusb_get_pollfds(NULL);
3b533202
BV
868 for (i = 0; lupfd[i]; i++)
869 sr_source_add(lupfd[i]->fd, lupfd[i]->events, TICK, handle_event,
a3508e33 870 (void *)sdi);
3b533202
BV
871 free(lupfd);
872
873 /* Send header packet to the session bus. */
874 packet.type = SR_DF_HEADER;
875 packet.payload = (unsigned char *)&header;
876 header.feed_version = 1;
877 gettimeofday(&header.starttime, NULL);
878 sr_session_send(cb_data, &packet);
879
880 /* Send metadata about the SR_DF_ANALOG packets to come. */
881 packet.type = SR_DF_META_ANALOG;
882 packet.payload = &meta;
88a13f30 883 meta.num_probes = NUM_PROBES;
3b533202
BV
884 sr_session_send(cb_data, &packet);
885
886 return SR_OK;
887}
888
3ffb6964
BV
889static int hw_dev_acquisition_stop(const struct sr_dev_inst *sdi,
890 void *cb_data)
3b533202 891{
269971dd
BV
892 struct dev_context *devc;
893
894 (void)cb_data;
3b533202 895
3b533202
BV
896 if (sdi->status != SR_ST_ACTIVE)
897 return SR_ERR;
898
a3508e33
BV
899 devc = sdi->priv;
900 devc->dev_state = STOPPING;
3b533202
BV
901
902 return SR_OK;
903}
904
62bb8840 905SR_PRIV struct sr_dev_driver hantek_dso_driver_info = {
3b533202
BV
906 .name = "hantek-dso",
907 .longname = "Hantek DSO",
908 .api_version = 1,
909 .init = hw_init,
910 .cleanup = hw_cleanup,
61136ea6 911 .scan = hw_scan,
811deee4
BV
912 .dev_list = hw_dev_list,
913 .dev_clear = clear_instances,
3b533202
BV
914 .dev_open = hw_dev_open,
915 .dev_close = hw_dev_close,
0b79bcbb 916 .info_get = hw_info_get,
3b533202 917 .dev_config_set = hw_dev_config_set,
62bb8840
UH
918 .dev_acquisition_start = hw_dev_acquisition_start,
919 .dev_acquisition_stop = hw_dev_acquisition_stop,
269971dd 920 .priv = NULL,
3b533202 921};