]> sigrok.org Git - libsigrok.git/blob - src/hardware/hantek-dso/api.c
hantek-dso: Add missing SR_PRIV.
[libsigrok.git] / src / hardware / hantek-dso / api.c
1 /*
2  * This file is part of the libsigrok 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 <config.h>
21 #include <math.h>
22 #include <stdio.h>
23 #include <stdint.h>
24 #include <stdlib.h>
25 #include <sys/types.h>
26 #include <sys/stat.h>
27 #include <fcntl.h>
28 #include <unistd.h>
29 #include <string.h>
30 #include <sys/time.h>
31 #include <inttypes.h>
32 #include <glib.h>
33 #include <libusb.h>
34 #include <libsigrok/libsigrok.h>
35 #include "libsigrok-internal.h"
36 #include "protocol.h"
37
38 /* Max time in ms before we want to check on USB events */
39 /* TODO tune this properly */
40 #define TICK 1
41
42 #define NUM_TIMEBASE 10
43 #define NUM_VDIV     8
44
45 #define NUM_BUFFER_SIZES 2
46
47 static const uint32_t scanopts[] = {
48         SR_CONF_CONN,
49 };
50
51 static const uint32_t drvopts[] = {
52         SR_CONF_OSCILLOSCOPE,
53 };
54
55 static const uint32_t devopts[] = {
56         SR_CONF_CONTINUOUS,
57         SR_CONF_CONN | SR_CONF_GET,
58         SR_CONF_LIMIT_FRAMES | SR_CONF_SET,
59         SR_CONF_TIMEBASE | SR_CONF_GET | SR_CONF_SET | SR_CONF_LIST,
60         SR_CONF_NUM_HDIV | SR_CONF_GET,
61         SR_CONF_CAPTURE_RATIO | SR_CONF_GET | SR_CONF_SET,
62         SR_CONF_TRIGGER_SOURCE | SR_CONF_GET | SR_CONF_SET | SR_CONF_LIST,
63         SR_CONF_TRIGGER_SLOPE | SR_CONF_GET | SR_CONF_SET,
64         SR_CONF_BUFFERSIZE | SR_CONF_GET | SR_CONF_SET | SR_CONF_LIST,
65         SR_CONF_SAMPLERATE | SR_CONF_GET | SR_CONF_SET | SR_CONF_LIST,
66         SR_CONF_NUM_VDIV | SR_CONF_GET,
67         SR_CONF_TRIGGER_LEVEL | SR_CONF_GET | SR_CONF_SET,
68 };
69
70 static const uint32_t devopts_cg[] = {
71         SR_CONF_VDIV | SR_CONF_GET | SR_CONF_SET | SR_CONF_LIST,
72         SR_CONF_COUPLING | SR_CONF_GET | SR_CONF_SET | SR_CONF_LIST,
73         SR_CONF_FILTER | SR_CONF_GET | SR_CONF_SET | SR_CONF_LIST,
74 };
75
76 static const char *channel_names[] = {
77         "CH1", "CH2",
78 };
79
80 static const uint64_t buffersizes_32k[] = {
81         (10 * 1024), (32 * 1024),
82 };
83 static const uint64_t buffersizes_512k[] = {
84         (10 * 1024), (512 * 1024),
85 };
86 static const uint64_t buffersizes_14k[] = {
87         (10 * 1024), (14 * 1024),
88 };
89
90 static const struct dso_profile dev_profiles[] = {
91         {       0x04b4, 0x2090, 0x04b5, 0x2090,
92                 "Hantek", "DSO-2090",
93                 buffersizes_32k,
94                 "hantek-dso-2090.fw" },
95         {       0x04b4, 0x2150, 0x04b5, 0x2150,
96                 "Hantek", "DSO-2150",
97                 buffersizes_32k,
98                 "hantek-dso-2150.fw" },
99         {       0x04b4, 0x2250, 0x04b5, 0x2250,
100                 "Hantek", "DSO-2250",
101                 buffersizes_512k,
102                 "hantek-dso-2250.fw" },
103         {       0x04b4, 0x5200, 0x04b5, 0x5200,
104                 "Hantek", "DSO-5200",
105                 buffersizes_14k,
106                 "hantek-dso-5200.fw" },
107         {       0x04b4, 0x520a, 0x04b5, 0x520a,
108                 "Hantek", "DSO-5200A",
109                 buffersizes_512k,
110                 "hantek-dso-5200A.fw" },
111         ALL_ZERO
112 };
113
114 static const uint64_t timebases[][2] = {
115         /* microseconds */
116         { 10, 1000000 },
117         { 20, 1000000 },
118         { 40, 1000000 },
119         { 100, 1000000 },
120         { 200, 1000000 },
121         { 400, 1000000 },
122         /* milliseconds */
123         { 1, 1000 },
124         { 2, 1000 },
125         { 4, 1000 },
126         { 10, 1000 },
127         { 20, 1000 },
128         { 40, 1000 },
129         { 100, 1000 },
130         { 200, 1000 },
131         { 400, 1000 },
132 };
133
134 static const uint64_t samplerates[] = {
135         SR_KHZ(20),
136         SR_KHZ(25),
137         SR_KHZ(50),
138         SR_KHZ(100),
139         SR_KHZ(200),
140         SR_KHZ(250),
141         SR_KHZ(500),
142         SR_MHZ(1),
143         SR_MHZ(2),
144         SR_MHZ(5),
145         SR_MHZ(10),
146         SR_MHZ(20),
147         SR_MHZ(25),
148         SR_MHZ(50),
149         SR_MHZ(100),
150         SR_MHZ(125),
151         /* Fast mode not supported yet.
152         SR_MHZ(200),
153         SR_MHZ(250), */
154 };
155
156 static const uint64_t vdivs[][2] = {
157         /* millivolts */
158         { 10, 1000 },
159         { 20, 1000 },
160         { 50, 1000 },
161         { 100, 1000 },
162         { 200, 1000 },
163         { 500, 1000 },
164         /* volts */
165         { 1, 1 },
166         { 2, 1 },
167         { 5, 1 },
168 };
169
170 static const char *trigger_sources[] = {
171         "CH1", "CH2", "EXT",
172         /* TODO: forced */
173 };
174
175 static const char *trigger_slopes[] = {
176         "r", "f",
177 };
178
179 static const char *coupling[] = {
180         "AC", "DC", "GND",
181 };
182
183 static struct sr_dev_inst *dso_dev_new(const struct dso_profile *prof)
184 {
185         struct sr_dev_inst *sdi;
186         struct sr_channel *ch;
187         struct sr_channel_group *cg;
188         struct dev_context *devc;
189         unsigned int i;
190
191         sdi = g_malloc0(sizeof(struct sr_dev_inst));
192         sdi->status = SR_ST_INITIALIZING;
193         sdi->vendor = g_strdup(prof->vendor);
194         sdi->model = g_strdup(prof->model);
195
196         /*
197          * Add only the real channels -- EXT isn't a source of data, only
198          * a trigger source internal to the device.
199          */
200         for (i = 0; i < ARRAY_SIZE(channel_names); i++) {
201                 ch = sr_channel_new(sdi, i, SR_CHANNEL_ANALOG, TRUE, channel_names[i]);
202                 cg = g_malloc0(sizeof(struct sr_channel_group));
203                 cg->name = g_strdup(channel_names[i]);
204                 cg->channels = g_slist_append(cg->channels, ch);
205                 sdi->channel_groups = g_slist_append(sdi->channel_groups, cg);
206         }
207
208         devc = g_malloc0(sizeof(struct dev_context));
209         devc->profile = prof;
210         devc->dev_state = IDLE;
211         devc->timebase = DEFAULT_TIMEBASE;
212         devc->samplerate = DEFAULT_SAMPLERATE;
213         devc->ch_enabled[0] = TRUE;
214         devc->ch_enabled[1] = TRUE;
215         devc->voltage[0] = DEFAULT_VOLTAGE;
216         devc->voltage[1] = DEFAULT_VOLTAGE;
217         devc->coupling[0] = DEFAULT_COUPLING;
218         devc->coupling[1] = DEFAULT_COUPLING;
219         devc->voffset_ch1 = DEFAULT_VERT_OFFSET;
220         devc->voffset_ch2 = DEFAULT_VERT_OFFSET;
221         devc->voffset_trigger = DEFAULT_VERT_TRIGGERPOS;
222         devc->framesize = DEFAULT_FRAMESIZE;
223         devc->triggerslope = SLOPE_POSITIVE;
224         devc->triggersource = g_strdup(DEFAULT_TRIGGER_SOURCE);
225         devc->capture_ratio = DEFAULT_CAPTURE_RATIO;
226         sdi->priv = devc;
227
228         return sdi;
229 }
230
231 static int configure_channels(const struct sr_dev_inst *sdi)
232 {
233         struct dev_context *devc;
234         struct sr_channel *ch;
235         const GSList *l;
236         int p;
237
238         devc = sdi->priv;
239
240         g_slist_free(devc->enabled_channels);
241         devc->enabled_channels = NULL;
242         devc->ch_enabled[0] = devc->ch_enabled[1] = FALSE;
243         for (l = sdi->channels, p = 0; l; l = l->next, p++) {
244                 ch = l->data;
245                 if (p == 0)
246                         devc->ch_enabled[0] = ch->enabled;
247                 else
248                         devc->ch_enabled[1] = ch->enabled;
249                 if (ch->enabled)
250                         devc->enabled_channels = g_slist_append(devc->enabled_channels, ch);
251         }
252
253         return SR_OK;
254 }
255
256 static void clear_helper(struct dev_context *devc)
257 {
258         g_free(devc->triggersource);
259         g_slist_free(devc->enabled_channels);
260 }
261
262 static int dev_clear(const struct sr_dev_driver *di)
263 {
264         return std_dev_clear_with_callback(di, (std_dev_clear_callback)clear_helper);
265 }
266
267 static GSList *scan(struct sr_dev_driver *di, GSList *options)
268 {
269         struct drv_context *drvc;
270         struct dev_context *devc;
271         struct sr_dev_inst *sdi;
272         struct sr_usb_dev_inst *usb;
273         struct sr_config *src;
274         const struct dso_profile *prof;
275         GSList *l, *devices, *conn_devices;
276         struct libusb_device_descriptor des;
277         libusb_device **devlist;
278         int i, j;
279         const char *conn;
280         char connection_id[64];
281
282         drvc = di->context;
283
284         devices = 0;
285
286         conn = NULL;
287         for (l = options; l; l = l->next) {
288                 src = l->data;
289                 if (src->key == SR_CONF_CONN) {
290                         conn = g_variant_get_string(src->data, NULL);
291                         break;
292                 }
293         }
294         if (conn)
295                 conn_devices = sr_usb_find(drvc->sr_ctx->libusb_ctx, conn);
296         else
297                 conn_devices = NULL;
298
299         /* Find all Hantek DSO devices and upload firmware to all of them. */
300         libusb_get_device_list(drvc->sr_ctx->libusb_ctx, &devlist);
301         for (i = 0; devlist[i]; i++) {
302                 if (conn) {
303                         usb = NULL;
304                         for (l = conn_devices; l; l = l->next) {
305                                 usb = l->data;
306                                 if (usb->bus == libusb_get_bus_number(devlist[i])
307                                         && usb->address == libusb_get_device_address(devlist[i]))
308                                         break;
309                         }
310                         if (!l)
311                                 /* This device matched none of the ones that
312                                  * matched the conn specification. */
313                                 continue;
314                 }
315
316                 libusb_get_device_descriptor(devlist[i], &des);
317
318                 usb_get_port_path(devlist[i], connection_id, sizeof(connection_id));
319
320                 prof = NULL;
321                 for (j = 0; dev_profiles[j].orig_vid; j++) {
322                         if (des.idVendor == dev_profiles[j].orig_vid
323                                 && des.idProduct == dev_profiles[j].orig_pid) {
324                                 /* Device matches the pre-firmware profile. */
325                                 prof = &dev_profiles[j];
326                                 sr_dbg("Found a %s %s.", prof->vendor, prof->model);
327                                 sdi = dso_dev_new(prof);
328                                 sdi->connection_id = g_strdup(connection_id);
329                                 devices = g_slist_append(devices, sdi);
330                                 devc = sdi->priv;
331                                 if (ezusb_upload_firmware(drvc->sr_ctx, devlist[i],
332                                                 USB_CONFIGURATION, prof->firmware) == SR_OK)
333                                         /* Remember when the firmware on this device was updated */
334                                         devc->fw_updated = g_get_monotonic_time();
335                                 else
336                                         sr_err("Firmware upload failed");
337                                 /* Dummy USB address of 0xff will get overwritten later. */
338                                 sdi->conn = sr_usb_dev_inst_new(
339                                                 libusb_get_bus_number(devlist[i]), 0xff, NULL);
340                                 break;
341                         } else if (des.idVendor == dev_profiles[j].fw_vid
342                                 && des.idProduct == dev_profiles[j].fw_pid) {
343                                 /* Device matches the post-firmware profile. */
344                                 prof = &dev_profiles[j];
345                                 sr_dbg("Found a %s %s.", prof->vendor, prof->model);
346                                 sdi = dso_dev_new(prof);
347                                 sdi->connection_id = g_strdup(connection_id);
348                                 sdi->status = SR_ST_INACTIVE;
349                                 devices = g_slist_append(devices, sdi);
350                                 sdi->inst_type = SR_INST_USB;
351                                 sdi->conn = sr_usb_dev_inst_new(
352                                                 libusb_get_bus_number(devlist[i]),
353                                                 libusb_get_device_address(devlist[i]), NULL);
354                                 break;
355                         }
356                 }
357                 if (!prof)
358                         /* not a supported VID/PID */
359                         continue;
360         }
361         libusb_free_device_list(devlist, 1);
362
363         return std_scan_complete(di, devices);
364 }
365
366 static int dev_open(struct sr_dev_inst *sdi)
367 {
368         struct dev_context *devc;
369         struct sr_usb_dev_inst *usb;
370         int64_t timediff_us, timediff_ms;
371         int err;
372
373         devc = sdi->priv;
374         usb = sdi->conn;
375
376         /*
377          * If the firmware was recently uploaded, wait up to MAX_RENUM_DELAY_MS
378          * for the FX2 to renumerate.
379          */
380         err = SR_ERR;
381         if (devc->fw_updated > 0) {
382                 sr_info("Waiting for device to reset.");
383                 /* Takes >= 300ms for the FX2 to be gone from the USB bus. */
384                 g_usleep(300 * 1000);
385                 timediff_ms = 0;
386                 while (timediff_ms < MAX_RENUM_DELAY_MS) {
387                         if ((err = dso_open(sdi)) == SR_OK)
388                                 break;
389                         g_usleep(100 * 1000);
390                         timediff_us = g_get_monotonic_time() - devc->fw_updated;
391                         timediff_ms = timediff_us / 1000;
392                         sr_spew("Waited %" PRIi64 " ms.", timediff_ms);
393                 }
394                 sr_info("Device came back after %" PRIi64 " ms.", timediff_ms);
395         } else {
396                 err = dso_open(sdi);
397         }
398
399         if (err != SR_OK) {
400                 sr_err("Unable to open device.");
401                 return SR_ERR;
402         }
403
404         err = libusb_claim_interface(usb->devhdl, USB_INTERFACE);
405         if (err != 0) {
406                 sr_err("Unable to claim interface: %s.",
407                         libusb_error_name(err));
408                 return SR_ERR;
409         }
410
411         return SR_OK;
412 }
413
414 static int dev_close(struct sr_dev_inst *sdi)
415 {
416         dso_close(sdi);
417
418         return SR_OK;
419 }
420
421 static int config_get(uint32_t key, GVariant **data,
422         const struct sr_dev_inst *sdi, const struct sr_channel_group *cg)
423 {
424         struct dev_context *devc;
425         struct sr_usb_dev_inst *usb;
426         const char *s;
427         const uint64_t *vdiv;
428         int ch_idx;
429
430         switch (key) {
431         case SR_CONF_NUM_HDIV:
432                 *data = g_variant_new_int32(NUM_TIMEBASE);
433                 break;
434         case SR_CONF_NUM_VDIV:
435                 *data = g_variant_new_int32(NUM_VDIV);
436                 break;
437         }
438
439         if (!sdi)
440                 return SR_ERR_ARG;
441
442         devc = sdi->priv;
443         if (!cg) {
444                 switch (key) {
445                 case SR_CONF_TRIGGER_LEVEL:
446                         *data = g_variant_new_double(devc->voffset_trigger);
447                         break;
448                 case SR_CONF_CONN:
449                         if (!sdi->conn)
450                                 return SR_ERR_ARG;
451                         usb = sdi->conn;
452                         if (usb->address == 255)
453                                 /* Device still needs to re-enumerate after firmware
454                                  * upload, so we don't know its (future) address. */
455                                 return SR_ERR;
456                         *data = g_variant_new_printf("%d.%d", usb->bus, usb->address);
457                         break;
458                 case SR_CONF_TIMEBASE:
459                         *data = g_variant_new("(tt)", timebases[devc->timebase][0],
460                                         timebases[devc->timebase][1]);
461                         break;
462                 case SR_CONF_SAMPLERATE:
463                         *data = g_variant_new_uint64(devc->samplerate);
464                         break;
465                 case SR_CONF_BUFFERSIZE:
466                         *data = g_variant_new_uint64(devc->framesize);
467                         break;
468                 case SR_CONF_TRIGGER_SOURCE:
469                         *data = g_variant_new_string(devc->triggersource);
470                         break;
471                 case SR_CONF_TRIGGER_SLOPE:
472                         s = (devc->triggerslope == SLOPE_POSITIVE) ? "r" : "f";
473                         *data = g_variant_new_string(s);
474                         break;
475                 case SR_CONF_CAPTURE_RATIO:
476                         *data = g_variant_new_uint64(devc->capture_ratio);
477                         break;
478                 default:
479                         return SR_ERR_NA;
480                 }
481         } else {
482                 if (sdi->channel_groups->data == cg)
483                         ch_idx = 0;
484                 else if (sdi->channel_groups->next->data == cg)
485                         ch_idx = 1;
486                 else
487                         return SR_ERR_ARG;
488                 switch (key) {
489                 case SR_CONF_FILTER:
490                         *data = g_variant_new_boolean(devc->filter[ch_idx]);
491                         break;
492                 case SR_CONF_VDIV:
493                         vdiv = vdivs[devc->voltage[ch_idx]];
494                         *data = g_variant_new("(tt)", vdiv[0], vdiv[1]);
495                         break;
496                 case SR_CONF_COUPLING:
497                         *data = g_variant_new_string(coupling[devc->coupling[ch_idx]]);
498                         break;
499                 }
500         }
501
502         return SR_OK;
503 }
504
505 static int config_set(uint32_t key, GVariant *data,
506         const struct sr_dev_inst *sdi, const struct sr_channel_group *cg)
507 {
508         struct dev_context *devc;
509         int rat;
510         int ch_idx, idx;
511         float flt;
512
513         devc = sdi->priv;
514         if (!cg) {
515                 switch (key) {
516                 case SR_CONF_LIMIT_FRAMES:
517                         devc->limit_frames = g_variant_get_uint64(data);
518                         break;
519                 case SR_CONF_TRIGGER_LEVEL:
520                         flt = g_variant_get_double(data);
521                         if (flt < 0.0 || flt > 1.0) {
522                                 sr_err("Trigger level must be in [0.0,1.0].");
523                                 return SR_ERR_ARG;
524                         }
525                         devc->voffset_trigger = flt;
526                         if (dso_set_voffsets(sdi) != SR_OK)
527                                 return SR_ERR;
528                         break;
529                 case SR_CONF_TRIGGER_SLOPE:
530                         if ((idx = std_str_idx(data, ARRAY_AND_SIZE(trigger_slopes))) < 0)
531                                 return SR_ERR_ARG;
532                         devc->triggerslope = idx;
533                         break;
534                 case SR_CONF_CAPTURE_RATIO:
535                         rat = g_variant_get_uint64(data);
536                         if (rat < 0 || rat > 100) {
537                                 sr_err("Capture ratio must be in [0,100].");
538                                 return SR_ERR_ARG;
539                         } else
540                                 devc->capture_ratio = rat;
541                         break;
542                 case SR_CONF_BUFFERSIZE:
543                         if ((idx = std_u64_idx(data, devc->profile->buffersizes, NUM_BUFFER_SIZES)) < 0)
544                                 return SR_ERR_ARG;
545                         devc->framesize = devc->profile->buffersizes[idx];
546                         break;
547                 case SR_CONF_TIMEBASE:
548                         if ((idx = std_u64_tuple_idx(data, ARRAY_AND_SIZE(timebases))) < 0)
549                                 return SR_ERR_ARG;
550                         devc->timebase = idx;
551                         break;
552                 case SR_CONF_SAMPLERATE:
553                         if ((idx = std_u64_idx(data, ARRAY_AND_SIZE(samplerates))) < 0)
554                                 return SR_ERR_ARG;
555                         devc->samplerate = samplerates[idx];
556                         if (dso_set_trigger_samplerate(sdi) != SR_OK)
557                                 return SR_ERR;
558                         break;
559                 case SR_CONF_TRIGGER_SOURCE:
560                         if ((idx = std_str_idx(data, ARRAY_AND_SIZE(trigger_sources))) < 0)
561                                 return SR_ERR_ARG;
562                         devc->triggersource = g_strdup(trigger_sources[idx]);
563                         break;
564                 default:
565                         return SR_ERR_NA;
566                 }
567         } else {
568                 if (sdi->channel_groups->data == cg)
569                         ch_idx = 0;
570                 else if (sdi->channel_groups->next->data == cg)
571                         ch_idx = 1;
572                 else
573                         return SR_ERR_ARG;
574                 switch (key) {
575                 case SR_CONF_FILTER:
576                         devc->filter[ch_idx] = g_variant_get_boolean(data);
577                         break;
578                 case SR_CONF_VDIV:
579                         if ((idx = std_u64_tuple_idx(data, ARRAY_AND_SIZE(vdivs))) < 0)
580                                 return SR_ERR_ARG;
581                         devc->voltage[ch_idx] = idx;
582                         break;
583                 case SR_CONF_COUPLING:
584                         if ((idx = std_str_idx(data, ARRAY_AND_SIZE(coupling))) < 0)
585                                 return SR_ERR_ARG;
586                         devc->coupling[ch_idx] = idx;
587                         break;
588                 default:
589                         return SR_ERR_NA;
590                 }
591         }
592
593         return SR_OK;
594 }
595
596 static int config_list(uint32_t key, GVariant **data,
597         const struct sr_dev_inst *sdi, const struct sr_channel_group *cg)
598 {
599         struct dev_context *devc;
600
601         if (!cg) {
602                 switch (key) {
603                 case SR_CONF_SCAN_OPTIONS:
604                 case SR_CONF_DEVICE_OPTIONS:
605                         return STD_CONFIG_LIST(key, data, sdi, cg, scanopts, drvopts, devopts);
606                 case SR_CONF_BUFFERSIZE:
607                         if (!sdi)
608                                 return SR_ERR_ARG;
609                         devc = sdi->priv;
610                         *data = std_gvar_array_u64(devc->profile->buffersizes, NUM_BUFFER_SIZES);
611                         break;
612                 case SR_CONF_SAMPLERATE:
613                         *data = std_gvar_samplerates(ARRAY_AND_SIZE(samplerates));
614                         break;
615                 case SR_CONF_TIMEBASE:
616                         *data = std_gvar_tuple_array(ARRAY_AND_SIZE(timebases));
617                         break;
618                 case SR_CONF_TRIGGER_SOURCE:
619                         *data = g_variant_new_strv(ARRAY_AND_SIZE(trigger_sources));
620                         break;
621                 case SR_CONF_TRIGGER_SLOPE:
622                         *data = g_variant_new_strv(ARRAY_AND_SIZE(trigger_slopes));
623                         break;
624                 default:
625                         return SR_ERR_NA;
626                 }
627         } else {
628                 switch (key) {
629                 case SR_CONF_DEVICE_OPTIONS:
630                         *data = std_gvar_array_u32(ARRAY_AND_SIZE(devopts_cg));
631                         break;
632                 case SR_CONF_COUPLING:
633                         *data = g_variant_new_strv(ARRAY_AND_SIZE(coupling));
634                         break;
635                 case SR_CONF_VDIV:
636                         *data = std_gvar_tuple_array(ARRAY_AND_SIZE(vdivs));
637                         break;
638                 default:
639                         return SR_ERR_NA;
640                 }
641         }
642
643         return SR_OK;
644 }
645
646 static void send_chunk(struct sr_dev_inst *sdi, unsigned char *buf,
647                 int num_samples)
648 {
649         struct sr_datafeed_packet packet;
650         struct sr_datafeed_analog analog;
651         struct sr_analog_encoding encoding;
652         struct sr_analog_meaning meaning;
653         struct sr_analog_spec spec;
654         struct dev_context *devc = sdi->priv;
655         GSList *channels = devc->enabled_channels;
656
657         packet.type = SR_DF_ANALOG;
658         packet.payload = &analog;
659         /* TODO: support for 5xxx series 9-bit samples */
660         sr_analog_init(&analog, &encoding, &meaning, &spec, 0);
661         analog.num_samples = num_samples;
662         analog.meaning->mq = SR_MQ_VOLTAGE;
663         analog.meaning->unit = SR_UNIT_VOLT;
664         analog.meaning->mqflags = 0;
665         /* TODO: Check malloc return value. */
666         analog.data = g_try_malloc(num_samples * sizeof(float));
667
668         for (int ch = 0; ch < NUM_CHANNELS; ch++) {
669                 if (!devc->ch_enabled[ch])
670                         continue;
671
672                 float range = ((float)vdivs[devc->voltage[ch]][0] / vdivs[devc->voltage[ch]][1]) * 8;
673                 float vdivlog = log10f(range / 255);
674                 int digits = -(int)vdivlog + (vdivlog < 0.0);
675                 analog.encoding->digits = digits;
676                 analog.spec->spec_digits = digits;
677                 analog.meaning->channels = g_slist_append(NULL, channels->data);
678
679                 for (int i = 0; i < num_samples; i++) {
680                         /*
681                          * The device always sends data for both channels. If a channel
682                          * is disabled, it contains a copy of the enabled channel's
683                          * data. However, we only send the requested channels to
684                          * the bus.
685                          *
686                          * Voltage values are encoded as a value 0-255 (0-512 on the
687                          * DSO-5200*), where the value is a point in the range
688                          * represented by the vdiv setting. There are 8 vertical divs,
689                          * so e.g. 500mV/div represents 4V peak-to-peak where 0 = -2V
690                          * and 255 = +2V.
691                          */
692                         /* TODO: Support for DSO-5xxx series 9-bit samples. */
693                         ((float *)analog.data)[i] = range / 255 * *(buf + i * 2 + 1 - ch) - range / 2;
694                 }
695                 sr_session_send(sdi, &packet);
696                 g_slist_free(analog.meaning->channels);
697
698                 channels = channels->next;
699         }
700         g_free(analog.data);
701 }
702
703 /*
704  * Called by libusb (as triggered by handle_event()) when a transfer comes in.
705  * Only channel data comes in asynchronously, and all transfers for this are
706  * queued up beforehand, so this just needs to chuck the incoming data onto
707  * the libsigrok session bus.
708  */
709 static void LIBUSB_CALL receive_transfer(struct libusb_transfer *transfer)
710 {
711         struct sr_datafeed_packet packet;
712         struct sr_dev_inst *sdi;
713         struct dev_context *devc;
714         int num_samples, pre;
715
716         sdi = transfer->user_data;
717         devc = sdi->priv;
718         sr_spew("receive_transfer(): status %s received %d bytes.",
719                 libusb_error_name(transfer->status), transfer->actual_length);
720
721         if (transfer->actual_length == 0)
722                 /* Nothing to send to the bus. */
723                 return;
724
725         num_samples = transfer->actual_length / 2;
726
727         sr_spew("Got %d-%d/%d samples in frame.", devc->samp_received + 1,
728                 devc->samp_received + num_samples, devc->framesize);
729
730         /*
731          * The device always sends a full frame, but the beginning of the frame
732          * doesn't represent the trigger point. The offset at which the trigger
733          * happened came in with the capture state, so we need to start sending
734          * from there up the session bus. The samples in the frame buffer
735          * before that trigger point came after the end of the device's frame
736          * buffer was reached, and it wrapped around to overwrite up until the
737          * trigger point.
738          */
739         if (devc->samp_received < devc->trigger_offset) {
740                 /* Trigger point not yet reached. */
741                 if (devc->samp_received + num_samples < devc->trigger_offset) {
742                         /* The entire chunk is before the trigger point. */
743                         memcpy(devc->framebuf + devc->samp_buffered * 2,
744                                         transfer->buffer, num_samples * 2);
745                         devc->samp_buffered += num_samples;
746                 } else {
747                         /*
748                          * This chunk hits or overruns the trigger point.
749                          * Store the part before the trigger fired, and
750                          * send the rest up to the session bus.
751                          */
752                         pre = devc->trigger_offset - devc->samp_received;
753                         memcpy(devc->framebuf + devc->samp_buffered * 2,
754                                         transfer->buffer, pre * 2);
755                         devc->samp_buffered += pre;
756
757                         /* The rest of this chunk starts with the trigger point. */
758                         sr_dbg("Reached trigger point, %d samples buffered.",
759                                 devc->samp_buffered);
760
761                         /* Avoid the corner case where the chunk ended at
762                          * exactly the trigger point. */
763                         if (num_samples > pre)
764                                 send_chunk(sdi, transfer->buffer + pre * 2,
765                                                 num_samples - pre);
766                 }
767         } else {
768                 /* Already past the trigger point, just send it all out. */
769                 send_chunk(sdi, transfer->buffer, num_samples);
770         }
771
772         devc->samp_received += num_samples;
773
774         /* Everything in this transfer was either copied to the buffer or
775          * sent to the session bus. */
776         g_free(transfer->buffer);
777         libusb_free_transfer(transfer);
778
779         if (devc->samp_received >= devc->framesize) {
780                 /* That was the last chunk in this frame. Send the buffered
781                  * pre-trigger samples out now, in one big chunk. */
782                 sr_dbg("End of frame, sending %d pre-trigger buffered samples.",
783                         devc->samp_buffered);
784                 send_chunk(sdi, devc->framebuf, devc->samp_buffered);
785                 g_free(devc->framebuf);
786                 devc->framebuf = NULL;
787
788                 /* Mark the end of this frame. */
789                 packet.type = SR_DF_FRAME_END;
790                 sr_session_send(sdi, &packet);
791
792                 if (devc->limit_frames && ++devc->num_frames >= devc->limit_frames) {
793                         /* Terminate session */
794                         devc->dev_state = STOPPING;
795                 } else {
796                         devc->dev_state = NEW_CAPTURE;
797                 }
798         }
799 }
800
801 static int handle_event(int fd, int revents, void *cb_data)
802 {
803         const struct sr_dev_inst *sdi;
804         struct sr_datafeed_packet packet;
805         struct timeval tv;
806         struct sr_dev_driver *di;
807         struct dev_context *devc;
808         struct drv_context *drvc;
809         int num_channels;
810         uint32_t trigger_offset;
811         uint8_t capturestate;
812
813         (void)fd;
814         (void)revents;
815
816         sdi = cb_data;
817         di = sdi->driver;
818         drvc = di->context;
819         devc = sdi->priv;
820         if (devc->dev_state == STOPPING) {
821                 /* We've been told to wind up the acquisition. */
822                 sr_dbg("Stopping acquisition.");
823                 /*
824                  * TODO: Doesn't really cancel pending transfers so they might
825                  * come in after SR_DF_END is sent.
826                  */
827                 usb_source_remove(sdi->session, drvc->sr_ctx);
828
829                 std_session_send_df_end(sdi);
830
831                 devc->dev_state = IDLE;
832
833                 return TRUE;
834         }
835
836         /* Always handle pending libusb events. */
837         tv.tv_sec = tv.tv_usec = 0;
838         libusb_handle_events_timeout(drvc->sr_ctx->libusb_ctx, &tv);
839
840         /* TODO: ugh */
841         if (devc->dev_state == NEW_CAPTURE) {
842                 if (dso_capture_start(sdi) != SR_OK)
843                         return TRUE;
844                 if (dso_enable_trigger(sdi) != SR_OK)
845                         return TRUE;
846 //              if (dso_force_trigger(sdi) != SR_OK)
847 //                      return TRUE;
848                 sr_dbg("Successfully requested next chunk.");
849                 devc->dev_state = CAPTURE;
850                 return TRUE;
851         }
852         if (devc->dev_state != CAPTURE)
853                 return TRUE;
854
855         if ((dso_get_capturestate(sdi, &capturestate, &trigger_offset)) != SR_OK)
856                 return TRUE;
857
858         sr_dbg("Capturestate %d.", capturestate);
859         sr_dbg("Trigger offset 0x%.6x.", trigger_offset);
860         switch (capturestate) {
861         case CAPTURE_EMPTY:
862                 if (++devc->capture_empty_count >= MAX_CAPTURE_EMPTY) {
863                         devc->capture_empty_count = 0;
864                         if (dso_capture_start(sdi) != SR_OK)
865                                 break;
866                         if (dso_enable_trigger(sdi) != SR_OK)
867                                 break;
868 //                      if (dso_force_trigger(sdi) != SR_OK)
869 //                              break;
870                         sr_dbg("Successfully requested next chunk.");
871                 }
872                 break;
873         case CAPTURE_FILLING:
874                 /* No data yet. */
875                 break;
876         case CAPTURE_READY_8BIT:
877         case CAPTURE_READY_2250:
878                 /* Remember where in the captured frame the trigger is. */
879                 devc->trigger_offset = trigger_offset;
880
881                 num_channels = (devc->ch_enabled[0] && devc->ch_enabled[1]) ? 2 : 1;
882                 devc->framebuf = g_malloc(devc->framesize * num_channels * 2);
883                 devc->samp_buffered = devc->samp_received = 0;
884
885                 /* Tell the scope to send us the first frame. */
886                 if (dso_get_channeldata(sdi, receive_transfer) != SR_OK)
887                         break;
888
889                 /*
890                  * Don't hit the state machine again until we're done fetching
891                  * the data we just told the scope to send.
892                  */
893                 devc->dev_state = FETCH_DATA;
894
895                 /* Tell the frontend a new frame is on the way. */
896                 packet.type = SR_DF_FRAME_BEGIN;
897                 sr_session_send(sdi, &packet);
898                 break;
899         case CAPTURE_READY_9BIT:
900                 /* TODO */
901                 sr_err("Not yet supported.");
902                 break;
903         case CAPTURE_TIMEOUT:
904                 /* Doesn't matter, we'll try again next time. */
905                 break;
906         default:
907                 sr_dbg("Unknown capture state: %d.", capturestate);
908                 break;
909         }
910
911         return TRUE;
912 }
913
914 static int dev_acquisition_start(const struct sr_dev_inst *sdi)
915 {
916         struct dev_context *devc;
917         struct sr_dev_driver *di = sdi->driver;
918         struct drv_context *drvc = di->context;
919
920         devc = sdi->priv;
921
922         if (configure_channels(sdi) != SR_OK) {
923                 sr_err("Failed to configure channels.");
924                 return SR_ERR;
925         }
926
927         if (dso_init(sdi) != SR_OK)
928                 return SR_ERR;
929
930         if (dso_capture_start(sdi) != SR_OK)
931                 return SR_ERR;
932
933         devc->dev_state = CAPTURE;
934         usb_source_add(sdi->session, drvc->sr_ctx, TICK, handle_event, (void *)sdi);
935
936         std_session_send_df_header(sdi);
937
938         return SR_OK;
939 }
940
941 static int dev_acquisition_stop(struct sr_dev_inst *sdi)
942 {
943         struct dev_context *devc;
944
945         devc = sdi->priv;
946         devc->dev_state = STOPPING;
947         devc->num_frames = 0;
948
949         return SR_OK;
950 }
951
952 static struct sr_dev_driver hantek_dso_driver_info = {
953         .name = "hantek-dso",
954         .longname = "Hantek DSO",
955         .api_version = 1,
956         .init = std_init,
957         .cleanup = std_cleanup,
958         .scan = scan,
959         .dev_list = std_dev_list,
960         .dev_clear = dev_clear,
961         .config_get = config_get,
962         .config_set = config_set,
963         .config_list = config_list,
964         .dev_open = dev_open,
965         .dev_close = dev_close,
966         .dev_acquisition_start = dev_acquisition_start,
967         .dev_acquisition_stop = dev_acquisition_stop,
968         .context = NULL,
969 };
970 SR_REGISTER_DEV_DRIVER(hantek_dso_driver_info);